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Preface 


Robots are a key element in current industrial processes, as they can be 
applied to a number of tasks, increasing both quality and productivity. 
Traditionally, serial robots have been installed in factories, as their wide 
operating space allowed them to fulfill a number of tasks. However, due to 
their high moving mass and single kinematic chain structure, these robots 
present some disadvantages when high speed, accuracy or heavy load handling 
tasks have to be executed. Parallel robots provide an interesting alternative to 
these application fields, as their multiple kinematic chain structure offers 
increased stiffness, allowing reduced positioning errors, lighter mechanisms 
and increased load/weight ratios. In this book, Chapter One addresses a new 
control strategy for parallel manipulators based on Li adaptive control. This 
latter is known for its decoupled control and estimation loops, enabling fast 
adaptation and guaranteed robustness. Chapter Two focuses on the control of 
parallel robots. Chapter Three reviews structure synthesis of fully-isotropic 
two-rotational and two-translational parallel robotic manipulators. Chapter 
Four reviews the new prototype of the two-legged, parallel kinematic walking 
robot CENTAUROB, developed at Hamburg University of Technology. 
Chapter Five analyzes and robustly controls the 6-DOF 3-legged Wide-Open 
parallel manipulator, using a Lyapunov analysis approach. 

In Chapter 1, the authors address a new control strategy for parallel 
manipulators based on adaptive control. This latter is known for its 

decoupled control and estimation loops, enabling fast adaptation and 
guaranteed robustness. To improve the tracking performance of parallel 
manipulators, the authors propose in this work to include the dynamic model 
of the robot in the control loop of adaptive control. The additional 
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dynamics-based term partially compensates for inherent nonlinear dynamics of 
the robot in order to reduce the impact of uncertainties on the closed-loop 
system and enhance the overall control performance. Real-time experiments, 
conducted on a 4-DOF fast parallel manipulator developed in the laboratory, 
demonstrate the effectiveness of the proposed controller and its superiority 
compared to standard adaptive control in terms of tracking performance. 

As explained in Chapter 2, robots are a key element in current industrial 
processes, as they can be applied to a number of tasks, increasing both quality 
and productivity. Traditionally, serial robots have been installed in factories, 
as their wide operating space allowed them to fulfill a number of tasks. 
However, due to their high moving mass and single kinematic chain structure, 
these robots present some disadvantages when high speed, accuracy or heavy 
load handling tasks have to be executed. 

Parallel robots provide an interesting alternative to these application 
fields, as their multiple kinematic chain structure offers increased stiffness, 
allowing reduced positioning errors, lighter mechanisms and increased 
load/weight ratios. These capabilities make these robots suitable for those 
tasks where high accelerations and speeds, micrometric precision or heavy 
load handling are required. 

In Chapter 2, a solution based on the use of extra sensors attached to the 
unactuated joints of the parallel robot is detailed. The extra information 
provided by these sensors can be used to implement a model-based control 
approach that combines the performance of advanced control techniques and 
the robustness of sensor redundancy. In order to implement this approach, 
three major areas will be analyzed in the next sections: dynamic modelling, 
control law definition, and sensitivity, considering the well-known Gough- 
Stewart platform as study case. 

Strong kinematic coupling is one of inherent properties for general parallel 
robotic manipulators. Although it contributes high stiffness and large loading 
capability, it also leads to complicated kinematic solutions, difficult 
controlling design and path planning, which will take passive effects for the 
actual applications of the parallel manipulators. A new systematic method for 
structure synthesis of four-degree-of-freedom fully-isotropic parallel robotic 
manipulators is proposed in Chapter 3. The moving platform of the mechanism 
consists of two-rotational and two-translational (2R2T) motion components 
with respect to the fixed base. Firstly, structure synthesis of uncoupled 2R2T 
parallel robotic manipulator is set up based on the concept of hybrid 
mechanism and the reciprocal screw theory for the first time. Then, type 
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synthesis of fully-isotropic 2R2T parallel robotic manipulator is performed by 
changing one kinematical chain’s structure of the uncoupled parallel robotic 
manipulator obtained before. A lot of novel uncoupled and fully-isotropic 
2R2T parallel robotic manipulators are synthesized. Kinematical Jacobian of a 
fully-isotropic 2R2T parallel robot is a 4x4 identity matrix, so there is a one- 
to-one linear mapping correspondence between the output velocity of the 
platform and the input velocity of the actuated joints. Therefore, one 
independent output of the moving platform can be controlled only by one 
actuator. 

In Chapter 4, the authors review the new prototype of the two-legged, 
parallel kinematic walking robot CENTAUROB, developed at Hamburg 
University of Technology. The main features of this robot are its modular, 
symmetric structure, the construction of the legs as Stewart platforms 
(hexapods), and the special C-shaped feet that allow a statically stable 
movement at any time. The symmetric structure of the robot leads to a center 
of gravity exactly in the middle of the hip and prevents from a preferred 
moving direction or an asymmetric load of the legs. As a highly flexible 
walking device, the CENTAUROB is able to walk in unpaved environment, 
avoid and overcome obstacles, and even handle straight and circular stairs. 

In Chapter 5, the authors analyze and robustly control the 6-DOF 3-legged 
Wide-Open parallel manipulator, using a Lyapunov analysis approach. The 
mechanism is evaluated in terms of kinematics, workspace, and dynamics. By 
implementing the dynamic model, tracking control of the moving platform is 
performed using the nonlinear sliding-mode control method. The numerical 
simulations with desired trajectory inputs attest to the excellent performance 
and robustness of the designed position tracking sliding-mode controller, in 
presence of fast varying uncertain parameters and external disturbances, which 
are common in parallel manipulators. 
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Chapter 1 


Adaptive Control of Parallel 
Manipulators: Design and Real-Time 

Experiments 

M. Bennehar*, A. Chemori\ S. Krufi and F. Pierrot § 
LIRMM, Montpellier, France 


Abstract 

In this chapter, we address a new control strategy for parallel manipu¬ 
lators based on C\ adaptive control. This latter is known for its decoupled 
control and estimation loops, enabling fast adaptation and guaranteed ro¬ 
bustness. To improve the tracking performance of parallel manipulators, 
we propose in this work to include the dynamic model of the robot in the 
control loop of C\ adaptive control. The additional dynamics-based term 
partially compensates for inherent nonlinear dynamics of the robot in or¬ 
der to reduce the impact of uncertainties on the closed-loop system and 
enhance the overall control performance. Real-time experiments, con¬ 
ducted on a 4-DOF fast parallel manipulator developed in our laboratory, 
demonstrate the effectiveness of the proposed controller and its superior¬ 
ity compared to standard C\ adaptive control in terms of tracking perfor¬ 
mance. 

Keywords: Parallel manipulators, adaptive control, nonlinear system, dynamics 

* E-mail address: bennehar@lirmm.fr 
E-mail address: chemori @ lirmm.fr 

* E-mail address: krut@lirmm.fr 

^E-mail address: pierrot@lirmm.fr 



2 


M. Bennehar, A. Chemori, S. Krut et al. 


1. Introduction 

Adaptive control of parallel manipulators has been a decades-long area of re¬ 
search. It is a very relevant control strategy when it comes to control such 
systems due to the abundance of uncertainties and variations of their dynamics 
and the environment they interact with. Undoubtedly, using model-based con¬ 
trollers with constant dynamic parameters (e.g. computed torque [1], augmented 
PD [2], PD+ [3], etc.) significantly improves the overall performance of paral¬ 
lel manipulators and enhance their tracking capabilities. However, such control 
schemes are not endowed with automatic adjustment mechanisms (adaptation) 
to cope with variations and uncertainties in the dynamics of the controlled sys¬ 
tem and, hence, do not yield the expected performance. As a result, adaptive 
control seems to be a promising solution to account for such limitation by es¬ 
timating and compensating the uncertainties in real-time to provide improved 
tracking and enhanced closed-loop performance. 

The first attempts to apply adaptive control to mechanical manipulators were 
based on restrictive assumptions and hypotheses about their dynamics not nec¬ 
essarily reflecting the real properties of these systems. For instance, the pro¬ 
posed controller in [4], which is based on Model Reference Adaptive Control 
(MRAC), does not consider the coupling between the joints. Such hypothesis is 
questionable since mechanical manipulators are known for their coupled non¬ 
linear dynamics. To relax this requirement, another MRAC-based controller has 
been proposed in [5]. The full dynamics of the manipulator as well as the cou¬ 
pling between the joints were explicitly considered and new adaptive laws were 
accordingly derived. Unfortunately for this controller, the number of parame¬ 
ters to be estimated is high, even for simple manipulators (11 parameters for the 
provided 3-DOF serial manipulator example). 

One major reason of the failure of MRAC-based controllers lies in the fact 
that the nonlinear structure of the dynamics of the system is not taken into ac¬ 
count. Considering this weakness, many researchers have investigated alter¬ 
native adaptive control architectures inspired from non-adaptive model-based 
controllers. In [6], an adaptive version of the computed torque scheme has been 
proposed. A stability analysis based on the Lyapunov theory was conducted to 
derive the adaptation law that provided both the tracking of the desired trajec¬ 
tories as well as the convergence of the estimated parameters. Nevertheless, in 
this work, the control law showed two main limitations, namely the need of the 
measured actual joint accelerations and the boundedness of the inverse of the 



Adaptive Control of Parallel Manipulators 


3 


estimated inertia matrix. These two limitations were bypassed in [7] by online 
estimating the measured accelerations while the former issue has been solved 
by following an approach inspired from robust control theory. Similar adaptive 
approaches can be found in [8, 9]. 

Recently, a new control scheme called C\ adaptive control which seeks to 
revisit some primary issues in MRAC has been proposed [10, 11]. This control 
approach, being itself inspired from MRAC, includes a low-pass filtering tech¬ 
nique that decouples the estimation and control loops. This is of a tremendous 
importance since increasing the adaptation gain in conventional adaptive con¬ 
trol may hurt the robustness of the closed-loop system. Indeed, control signals 
in MRAC may have undesired high frequencies lying outside the control chan¬ 
nel bandwidth. The low-pass filter in C\ adaptive control, which is designed 
by using the C\ small gain theorem, is consequently introduced to remove these 
undesired frequencies. The first validations of C\ adaptive control were through 
numerical simulations and real-time experiments mainly in aerial vehicles [12]. 
It was afterwards extended to address more applications such as underwater 
vehicles [13], mechanical manipulators [14], underactuated systems [15] and 
parallel manipulators [16]. One major advantage of the C\ adaptive control is 
its being model-free; i.e. not requiring any knowledge about the dynamics of the 
system. However, it would be interesting to include, if available, some knowl¬ 
edge about the dynamics of the system in the control loop in order enhance its 
tracking performance and improve the overall closed-loop system. 

This chapter focuses on the development of a new control scheme based 
on the C\ adaptive control. The nominal nonlinear dynamics of the system are 
included in the control loop in order to improve its performance. Specifically, 
the proposed controller has a major advantage of improving the tracking perfor¬ 
mance which is crucial in most robotic applications. In order to demonstrate our 
claims, real-time experiments are conducted on Veloce; a 4-DOF parallel ma¬ 
nipulator developed in our laboratory intended to be used for high-speed pick- 
and-place applications. The remainder of this chapter is organized as follows. 
In section 2, we provide a brief state of the art on adaptive controllers proposed 
in the literature for parallel manipulators. Section 3 is devoted to the modeling 
and description of Veloce robot. In section 4, the control problem formulation 
and development of C\ adaptive control are provided. Section 6 is dedicated 
to the development of the new proposed control scheme which is based on C\ 
adaptive control. Real-time experimental results are presented and discussed in 
section 7 Finally, conclusions are drawn in section 8 
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2. Overview on Adaptive Control of Parallel 
Manipulators 

Adaptive controllers are those control schemes requiring a real-time adjustment 
(i.e. adaptation) of their parameters in the aim of finding their steady-state val¬ 
ues. The development of adaptive strategies is motivated by the abundance of 
uncertainties in the controlled system and its environment that may deteriorate 
the control performance. Adaptive controllers can be divided into two categories 
depending on their requirement of a dynamic model of the robot; non-model- 
based and model-based strategies. 

In what follows, we give a breif overview on the most prominent adaptive 
control schemes for parallel manipulators that can be found in the literature. 

2.1. Non-Model-Based Adaptive Strategies 

Strategies belonging to this class do not require the dynamic model of the robot 
nor its structure to be known. Instead, they consider all the nonlinearities includ¬ 
ing those of the dynamic model, uncertainties and possible disturbances, whose 
structure is unknown, as a general disturbance term to be estimated in real-time. 
Then, the control law is designed such that the effect of this disturbances is 
minimized. 

2.1.1. MRAC-Based Strategies 

The main idea of MRAC is to obtain a closed-loop system with adjustable con¬ 
troller parameters. These parameters have the ability of changing the behavior 
of the closed-loop system. The time evolution of the adaptive parameters is 
adjusted by comparing the output of the controlled system and the desired one 
obtained from the reference model. The ultimate goal is to make the behavior 
of the controlled system match a desired reference model despite the eventual 
variations/uncertainties in the system or its environment [17]. 

While numerous MRAC-based control schemes for serial manipulators can 
be found in the literature [19, 20], only few controllers were proposed for paral¬ 
lel ones. In [18], an adaptive control scheme based on MRAC has been proposed 
to control a 6-DOF parallel manipulator based on the Stewart platform prototype 
used to emulate space operations. In this work, the control scheme consisted of 
a joint space PD feedback controller with adjustable gains. The control scheme 
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Figure 1. Bloc diagram of the proposed MRAC-based control in [18]. 


is further endowed with an adaptation mechanism that controls the evolution of 
the adaptive feedback gains. The joint tracking error of each axis was supposed 
to follow a desired user-defined reference second order linear system character¬ 
ized by its natural frequency and its damping ratio. Based on Lyapunov stability 
analysis, the adaptation law stabilizing the error dynamics is derived. Exper¬ 
iments were conducted on a Stewart-platform parallel manipulator to evaluate 
the performance of the controller and its robustness towards sudden payload 
changes. Two case studies were considered; mainly, a vertical motion of the 
moving platform and a circular one. In both cases the proposed MRAC-based 
strategy with adaptive gains outperforms the PD with constant feedback gains. 
Figure 1 illustrates the block diagram summarizing the MRAC-based controller 
proposed in [18]. 

2.1.2. Strategies Based on Artificial Neural Networks 

Artificial Neural Networks (ANN) are known by their powerful universal ap¬ 
proximation features [21]. This is why they attracted a big deal of interest in 
various fields, and have been applied almost everywhere, from identification to 
estimation and control. Artificial neural networks learn from experience rather 
than programming, hence, they are typically used in repetitive tasks. Several 
works can be found in the literature regarding the application of neural net¬ 
works in control of parallel manipulators [22]. However they remain relatively 
few compared to what can be found for serial manipulators [23]. 
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Thanks to their learning ability, artificial neural networks are mostly used to 
approximate the dynamics of the manipulator. Then, the learned dynamics can 
be included in the control scheme to compensate for the uncertainties and dis¬ 
turbances. [24] proposed to augment a decentralized Cartesian space PID con¬ 
troller with an artificial neural network term. The main motivation of this work 
is to improve the tracking capabilities of a 2-DOF redundantly actuated parallel 
manipulator. The provided simulation results demonstrated the superiority of 
the augmented controller with respect to the original PID. The maximum errors 
were significantly reduced since the additional neural network term accounted 
for the nonlinear dynamics of the manipulator. 

2.2. Model-Based Adaptive Strategies 

Model-based adaptive controllers explicitly include the dynamics of the robot 
in the control loop. In contrast to their non-adaptive counterparts, the adap¬ 
tive schemes adjust the parameters of the model-based loop in order to con¬ 
verge them their best steady-space values. Consequently, if the dynamics of the 
manipulator is uncertain or time-varying, adaptive controllers result in a better 
closed-loop performance. 

2.2.1. Strategies Based on Computed Torque 

Computed-torque-based adaptive schemes are those controllers relying on the 
classical non-adaptive computed torque controller. The control design starts by 
considering the ideal non-adaptive controller that assumes perfect cancellation 
of the system nonlinearities. Due to possible uncertainties and variations in the 
system dynamics, the compensation of the nonlinearities of the system could 
not be as perfect as the non-adaptive controller assumes. Then, an additional 
adaptive estimation loop is considered to account for these uncertainties. The 
role of the adaptive loop is to estimate, in real-time, the system’s parameters and 
the obtained estimation are used in the controller. 

The typical example of a computed-torque-based adaptive controller is the 
one proposed in [25]. The first step of the control design in this work is to 
consider a computed torque control law with uncertain parameters. Then, the 
error equation resulting from the application of this control law is obtained. 
Based on a thorough stability analysis using the Lyapunov theory, an adaptive 
law for the parameters’ estimation is derived. The proposed adaptive controller 
in conjunction with the adaptation law guarantee that the tracking errors vanish 
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and that the estimated parameters converge to their best steady-state values. 
The block diagram depicted in Figure 2 clarifies the principle of such control 
strategy. 

The computed-torque-based adaptive controller, proposed in [25], was 
mainly developed for serial manipulators. However, it is known that parallel ma¬ 
nipulators share many properties with their serial counterparts [26, 27]. Based 
on this fact, the controller in [25] has been straightforwardly applied to PKMs in 
[28]. In this work, an adaptive Cartesian space computed-torque-based scheme 
is applied to a 2-DOF redundantly actuated parallel manipulator. Real-time 
experiments were carried out in order to highlight the benefits of the adaptive 
controller compared to its non-adaptive version. The adaptive controller shows 
a net superiority and allows to estimate the system dynamic parameters. 

A main drawback of computed torque based adaptive controllers is their de¬ 
pendence on the real acceleration of the robot [25]. This shortcoming is crucial 
from a practical point of view since measuring actual accelerations is tedious. 

2.2.2. Based on Passivity of the System 

Passivity-based controllers use the passivity property of the manipulator [7]. In 
contrast with computed-torque-based ones, passivity-based controllers do not 
assume perfect cancellation of the system nonlinearities, even in the ideal case 
of perfect knowledge of the manipulator’s parameters. Hence, they do not lead 
to a closed-loop linear error system. However, based on the passivity property 
of the system, they result in a stable closed-loop system. 

[8] proposed a passivity-based adaptive controller that holds many advanta¬ 
geous features. This controller can be assimilated to an adaptive version of PD 


Task-space 

trajectory 

generator 



Figure 2. Bloc diagram of adaptive computed torque control. 
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control with computed feedforward. Indeed, the proposed control law consists 
mainly in a PD feedback loop in addition to an adaptive feedforward term based 
on the dynamics of the robot and the desired reference trajectories. The main 
advantage of this scheme is that it does not require the joint acceleration mea¬ 
surement. Moreover, the compensation of the system’s nonlinearities is based 
on desired quantities that can be computed offline. This means that the con¬ 
trol scheme does not require heavy computations. Furthermore, the use of the 
desired values instead of the measured ones, which can be often noisy, may 
enhance the robustness of the controller toward measurement noise. 

In [29], the developed controller in [8] has been embraced for joint space 
control of a 6-DOF parallel manipulator called the Hexaglide. The proposed 
adaptive controller as well as a linear PD controller were implemented in real¬ 
time for a comparison purpose. It was not surprising that the adaptive controller 
provided better tracking results since it compensates for the nonlinear dynamics 
of the manipulator. 

In [30], a Cartesian space control strategy called Dual-Space Adaptive Con¬ 
trol is proposed to control redundantly actuated parallel manipulators. The pro¬ 
posed controller in this work share many similarities with the proposed control 
strategy in [29]. The main difference is that the weighting gain of the position 
error with respect to the velocity error is time-varying. The proposed controller 
was experimentally validated on the R4 parallel manipulator [31]. Real-time 
experiments showed that the proposed Dual-Space adaptive controller signifi¬ 
cantly improves the tracking performance and allows the tracking of extremely 
fast trajectories (up to 100G of maximum acceleration). 

Sadegh [32] proposed to extend the joint-space passivity based adaptive 
controller of [33], mainly developed for serial manipulators, to Cartesian-space 
control of parallel manipulators with actuation redundancy. Moreover, to deal 
with friction an additional control term has been added to the conventional feed¬ 
back and adaptive loops. Real-time experiments, conducted on a 2-DOF redun¬ 
dantly actuated parallel manipulator, showed the superiority of the proposed 
adaptive controller compared to the augmented PD controller in terms of Carte¬ 
sian tracking errors, at both low and high accelerations. Unfortunately, the evo¬ 
lution of the estimated parameters was not shown in this work to see if they 
really converge to their steady-state values. 
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3. Modeling of Delta-Like Parallel Robots: Application 
to Veloce 

Veloce is a 4-DOF Delta-like [34] fully actuated parallel manipulator having 
four identical kinematic chains [35]. Each kinematic chain can be seen as serial 
arrangement of the actuator, a rear-arm and a forearm. Its articulated moving 
platform illustrated in Figure 3, which is connected to the fixed-base through the 
kinematic chains, can perform three spatial translations and one rotation around 
the vertical axis. The rotation is obtained via the relative motion of the upper 
and lower parts of the moving platform. The four actuators responsible for the 
movement of the mechanical structure are all lying on the same plane. The CAD 
of Veloce is illustrated in Figure 4. 



Figure 3. Articulated moving platform of Veloce. 


3.1. Inverse Kinematics Model 

The inverse kinematics problem consists in finding the actuated joint vector 
q — [<Zi > Q 2 i Q 4 :] T C M 4 corresponding to a specific pose X = [x, y , z, s] T of 
the moving platform of Veloce. Figures 5 and 6 in addition to Table 1 summarize 
the various geometric parameters involved in the establishment of the inverse 
kinematic model of Veloce. The actuated joints locations are represented by 
points Ai, i = 1,... ,4, whose coordinates are given in the fixed Cartesian 
frame O — xyz by: 


Ai = r h [cos(a*), sin (a*), 0] T , 


(1) 



10 


M. Bennehar, A. Chemori, S. Krut et al. 



Figure 4. CAD view of Veloce 4-DOF parallel manipulator. 


where = (z — 1 )tt/2, i — 1,..., 4, is the orientation of the ith actuator axis 
with respect to the fixed Cartesian frame. The locations of the centers of passive 
ball joints are represented by points Bi and C{ which are expressed in the base 
frame O — xyz by: 

Bi =Ai + L [cos(aj) cos(%), sin(aj) cos(%), sin(<^)], (2) 

Ci = [r p cos(aj) + x, r p sin(aj) + y, z]. (3) 

Table 1. Geometric parameters of Veloce robot 


Parameter 

Description 

Value 

U 

Rear-arm length 

200 mm 

k 

Forearm length 

530 mm 

n 

Base radius 

135 mm 

r P 

Moving Platform radius 

48 mm 
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To facilitate the subsequent mathematical development, a frame P L — U{ViZ 
is attached to each actuator, where the vectors U{ and are given by: 

Ui = [cos(a*), sin(ai), 0] T , (4) 

Vi = [— sin(o'i), cos(ai), 0] T , (5) 

where V{ is always directed towards the ith actuator’s axis. The inverse kine¬ 
matics solution of Veloce robot can be obtained by finding the intersection 
of a circle and a sphere which represents the coordinates of the passive joints 
B l = [xBi, 0, ZBi\ T in the corresponding Ai — UiV{Z frame [36, 37]. Notice 
that in this frame, the Bi points always satisfy ys i = 0. 

From the motion of one rear-arm, we can write the equation of a circle in the 
corresponding Ai — UiZ plane of center Ai = [0, 0] and of radius L as follows: 

x \i + z Bi = L 2 ( 6 ) 

The movements of one forearm can be described by a sphere of center C t 



Figure 5. Geometric parameters of Veloce robot: top view. 
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Figure 6. Geometric parameters of Veloce robot: side view. 


and radius 1. In the Ai — UiViZ frame, we can write the following equation: 

(■ x Bi - xcf + y 2 Ci + (z Bi - z Ci ) 2 = l 2 (7) 

Subtracting (6) from (7) yields: 

2 x Ci x Bl + 2z Ci z Bi = l 2 -L 2 + x 2 c . + y 2 c . + z 2 c . (8) 

Solving (8) for zs i yields: 

Si - 2x Ci 


ZBi = 


2 ZCi 


with Si = l 2 — L 2 + Xq. + y 2 ,' + Zq.. Substituting (9) in (6) yields: 

4 ( ZCi + x 2 c .) x 2 b . - ASiXCiXBi + (. s 2 - Az^.L 2 ) = 0 

Solving for xBi results in: 

SiX Ci ± sj - JJ Ci + x 2 c ) ~[S 2 - 44 ^ 2 ) 


x Bi = 


(■ Z Ci + x c) 


(9) 


( 10 ) 


(ID 
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Equations (11) and (9) result in the coordinates of the intersection of a circle 
and a sphere. For geometrical reasons, only the largest x#. is kept. Once the 
coordinates of the points B h are found, the corresponding actuated joint value 
can be obtained by: 

qi = atan2(z Bi ,x Bi ) ( 12 ) 

Applying (12) to each of the four kinematic chains results in the solution of 
the inverse kinematic model of Veloce. 

3.2. Jacobian Matrix 

The Jacobian matrix J(q,X) G R 4x4 of Veloce relates its moving plat¬ 
form’s velocity vector X = [x,y,z,s] to the actuated joints velocity vector 
5 = [ 51 , 52 , 93 , 54 ] such that: 

X = Jq (13) 

Note that q and X are related through the inverse kinematic model. The Ja¬ 
cobian matrix J can be obtained based on the following kinematic relationship: 

WBiCif-l 2 = 0, (14) 

which means that the length of each forearm remains constant independently of 
the robot’s configuration. Differentiating (14) and rearranging the terms results 
in: 

J x X = J q q, (15) 

where J q and J x are given as follows: 

J q = diag (hwjsi,... ,l n w^s n ) , (16) 

Jx = [si • • • s n ] i (17) 

where 

Wi=tiX Vi 
. _ AiBi 
1 Li 
BiCi 


(18) 

(19) 


(20) 
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Finally, the Jacobian matrix can be written as follows: 

j _ 'hwjsi kwfsi 

5l Si 


( 21 ) 


3.3. Inverse Dynamic Model 

In this section, a brief description of the simplified dynamic model of Veloce 
is presented in the sequel. But first, to simplify the motion equations of the 
different parts of the mechanical structure of Veloce, the following assumptions, 
commonly used in Delta-like robots, are considered [37] 

Assumption 1. Both dry and viscous frictions in all passive and active joints 
are neglected. This is mainly due to the fact that the joints are carefully designed 
such that friction effects are minimized. 

Assumption 2. The rotational inertia of the forearms is neglected and their 
mass is split up into two equivalent parts, one is added to the mass of the arm 
while the other one is considered with the moving platform. This hypothesis is 
justified by the small mass of the forearms compared to other components. 

The dynamics of the Veloce robot shows a lot of similarities with those 
of the Delta robot. Nevertheless few differences arise due to the number of 
kinematic chains and the additional rotational DOF of the moving platform. 

Regarding the moving platform, we distinguish two kinds of forces acting 
on it, the gravity forces G p G M 4 and the inertial force F p G M 4 , they are given 
by 

G p = M p [0 0 - g 0] T (22) 

F p = M p X (23) 

Table 2. Dynamic parameters of Veloce robot 


Parameter 

Description 

Value 

m a 

One Rear-arm’s weight 

0.541 kg 

m f 

One Forearm’s weight 

0.08 kg 

m p 

Platform’s weight 

0.999 kg 
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where M p E R 4x4 is the mass matrix of the moving platform that also considers 
the half-masses of the forearms, g = 9.81 m/s 2 is the gravity constant and 
X E R 4 is the Cartesian acceleration vector. 

The contributions of G p and F p to each motor can be computed using the 
Jacobian matrix J(q, X ) E R 4x4 as follows 

r Gp = J t M p [ 00-5 0] T (24) 

r p = J t M p X (25) 

From the joints side, the elements that contribute to the dynamics of the 
actuators are the forces and torques resulting from the movement of the rear- 
arms in addition to the half-messes of the forearms. 

Applying the virtual work principle, which states that the sum of non-inertial 
forces is equal to that of the inertial ones, and after rearranging the terms, we 
get 

j t m p x + r Gp + I a q + r Ga = r (26) 

being I a E R 4x4 a diagonal inertia matrix of the arms accounting for the 
rear-arms as well as the half-masses of the forearms, q E R 4 the joint acceler¬ 
ation vector and Tc a E R 4 is the force vector resulting from gravity acting on 
the arms being given by 


r G a = m a r Ga gcos(q) (27) 

with m a the sum of the mass of one rear-arm and one half-mass of a forearm, 
VQ a the distance between the center of one axis and the center of mass of one 
arm and # 1 ,^ 2 , #3 and q ,4 are the joints positions. 

Given the kinematic relationship X = Jq + Jq, (26) can be rewritten as 
follows 

(la + J T M p J) q + (j T M p j ) q - ( J T G P + T Ga ) + T d = T, (28) 

where r d is a disturbance term that accounts for non-modeled dynamics and 
possible external disturbances. It can be written in a standard joint-space form 
as follows 

M(q)q + C(q, q)q + G(q) + = T, (29) 

with: 
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M(q) = I a + J T M P J the total mass matrix. 

C(q, q) = J T M p J the Coriolis and centrifugal forces matrix. 

G(q) — — ( J T G P + T Ga ) the gravitational forces vector. 

The expression of the dynamics in (29) is suitable for joint-space control 
since it is expressed in terms of the actuated joints. 


4. Background on C\ Adaptive Control 

In this section, the basic idea behind the development of the C\ adaptive control 
theory is detailed. For the sake of simplicity, we consider a single-input single¬ 
output system. Since C\ adaptive control is inspired from MRAC, we first in¬ 
troduce MRAC for the considered system. Then the architecture of MRAC is 
changed to achieve the decoupling of robustness and adaptation. 


4.1. Control Problem Formulation 

Consider the following single-input single-output linear time-invariant system 


x(t) — Ax{t ) + bu(t)i x(0) = xo 
y(t ) = c T x(t ) 


(30) 


where 


x{t) G is the measurable state of the system, 
u(t) G M is the control input, 

6, c G R n are known constant input and output vectors, 
y(t) GK is the output to be regulated by the controller. 

The system state matrix A G M nxn is supposed unknown. The control 
objective is to design an adaptive control signal u(t) such that the regulated 
output of the system y(t) tracks a given reference signal r(t) G M with desired 
performance while guaranteeing that the system state and other signals remain 
bounded under the following assumption 
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Assumption 3. There exist a Hurwitz matrix A m G M nxn and a vector 6 G W 1 
of perfect parameters such that the pair (A m , b ) is controllable and A m — A = 
bO T . Moreover, assume that this unknown perfect parameters vector 6 belongs 
to a given compact set 0. 

Under the above assumption, the system in (30) can be rewritten as follows 

x{t) — A m x(t ) + b ( u(t ) — 0 T x(t )) , x(0) = xo 

y(t) = c T x(t) <31) 

4.2. From Direct MRAC to Direct MRAC with a State Predictor 

One of the key differences between MRAC and C\ adaptive control is the intro¬ 
duction of a prediction-based adaptive architecture. In the following, this new 
structure is highlighted and demonstrated that it leads to the same closed-loop 
behavior as direct MRAC. 

4.2.1. Direct MRAC 

Consider the nominal nonadaptive controller given by 

u nom (t ) = 0 T x(t) + k 9 r(t ) (32) 

where k 9 = 1/ (c T A^bJ is a feedforward gain that ensures zero steady-state 
tracking error. Substituting (32) in the system dynamics in (31) leads to the 
following desired reference system 

x m (t) = A m x m (t ) + bk 9 r(t), x(0) = x 0 
y m (t) = c T x m (t) 

where x m [t) is the state of the reference system and y m {t) its output. The 
nominal control law is impossible to implement due to the uncertainties in the 
system state matrix A (and, hence, 6) which should be estimated online. 

The feasible direct MRAC control law is hence given by 

u(t) — 0 T x(t) + k 9 r(t ) (34) 

where 9 G W 1 is an estimate of 9 whose evolution is governed by the following 
adaptation rule 


9(t) = 7 x(t)e T (t)Pb, (9(0) = k x0 


(35) 
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Figure 7. Block diagram of MRAC. 


where 7 G M + is the adaptation gain, e(t) = x m {t) — x(t) and P = P T > 0 is 
the solution for the algebraic Lyapunov equation A^P + PA m = —Q, for an 
arbitrary choice of Q = Q T > 0. 

Substituting the adaptive control law (34) in the system dynamics in (31) 
leads to the following error dynamics 

e(t) — A m e(t) — b0 T (t)x(t) (36) 

where 9 = 6(t) — 6 is the parameters estimation error. Figure 7 depicts the 
overall block diagram of MRAC. 

4.2.2. MRAC with a State Predictor 

Now consider the following state predictor that mimics the behavior of the sys¬ 
tem in (31) with the unknown parameter 6 replaced by its estimate 6{t) 

x{t) = A m x(t ) + b(u{t) — §x(t)), &(0) = xo 

y(t)=c T m 


where x{t) being the state of the predictor. The prediction error dynamics can 
be obtained by subtracting the system dynamics from those of the predictor as 
follows 

x(t) — A m x(t) — b0{t)x(t) (38) 

where x(t) = x(t) —x(t) is the prediction error. It can be seen that the prediction 
error dynamics is identical to the obtained error dynamics with direct MRAC in 
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(36). The adaptive law of the predictor-based controller is similar to that of 
direct MRAC, the only difference is the use of the prediction error x(t) instead 
of the tracking error e{t). It is thus given by 

6{t) = 7 x(t)x T {t)Pb, 0(0) = 0o (39) 


It can be noticed that the closed-loop state predictor mimics the behavior 
of the reference model in (33). Indeed, substituting the control law (34) in the 
predictor dynamics and upon the use of (39) we get the following closed-loop 
dynamics 

x(t) = A m x(t ) + bk g r(t), x(0) = xO, 
y{t) = c T x(t) 


which is identical to the dynamics of the reference system of direct MRAC 
in (33). It is demonstrated in [38] that the tracking (or prediction) errors are 
upper bounded at any time by 


e(*)ll(= 


5(011) < 


l|g(Q)ll 

Va min (P) 7 


(41) 


being 0(0) the initial parameters estimation error and A m in(P) the minimum 
eigenvalue of P. This means that the tracking error can be made arbitrarily 
small by increasing the adaptation gain 7. However, it can be seen from the 
control law in (34) and the adaptation laws in (35) and (39) that increasing 
the adaptation gain lead to high gain feedback. The block diagram of MRAC 
scheme with a state predictor is shown in Figure 8. 


4.3. Ci Adaptive Control 

In a real system, the unknown parameters vector 6 may be a time-varying uncer¬ 
tainty with frequencies that may lie outside the control channel bandwidth [38]. 
In this case, such frequencies are naturally attenuated due to hardware limita¬ 
tions of the actuators. Consequently, the behavior of the closed-loop system will 
be different than the dynamics of the reference model in (33). 

The control problem in C\ adaptive control is formulated with the under¬ 
standing that some uncertainties could never be perfectly compensated. Indeed, 
while the control objective in MRAC is only stated asymptotically, the closed- 
loop performance in C\ adaptive control is specified \/t > 0. This means that at 
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Figure 8. Block diagram of the control loop based on MRAC with state predic¬ 
tor. 

any time, the performance of the system can be predicted. Moreover, the control 
signal never exceeds the available control channel bandwidth. 

For the class of systems given by (31), consider the following state predictor 
that mimics its behavior 

x(t) = A m x(t) + b(u(t) - 0x(t)), x(0) = x 0 

y(t ) = c T x(t) 

In addition to the state predictor in (42), consider a projection-type adaption 
law for the estimated parameter vector 9 expressed as 

9(t) = 7 Proj (6(t),x(t)x(t)Pb^ , 0(0) = <9 0 (43) 

which is adjusted using the prediction error x{t ) = x(t) — x{t). The projection 
operator Proj avoids the parameters drift and ensures that they remain inside the 
compact set ©. In (43), 7 is the positive adaptation gain and P is the symmetric 
positive definite matrix, solution of the algebraic Lyapunov equation A^P + 
PA m = — Q for an arbitrary symmetric positive definite matrix Q. 

The last stage which is one of the notable unique features of the C\ adaptive 
control, is the control input characterized by the introduction of a low-pass filter. 
It is given by its Laplace form as follows 

u(s ) = C(s) ( fj(s ) + k g r(s )) (44) 

where C(s) is a bounded-input bounded-output strictly proper transfer function 
with C(0) = 1, r(s) is the Laplace transform of the reference trajectory r(t) 
and fj(s) is the Laplace transform of pit) — 0 T {t)x{t). 
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Figure 9. Block diagram of C\ adaptive control. 


It is demonstrated in [38] that the controlled system in (30) under the C\ 
adaptive control law in (44) is bounded-input bounded-state with respect to r{t) 
and xo if the following C\ -norm-based equality is satisfied 

\\G(s)\\ Cl L< 1 (45) 


where 

G(s) = H(s)(l — C(s)), H(s) ^ (si - A^-'b, L4max||0||i (46) 

The block diagram of the C\ adaptive control strategy for the class of sys¬ 
tems given by (31) is displayed in Figure 9. 

5. Application of C,\ Adaptive Control to Parallel 
Manipulators 

Recall the inverse dynamics for parallel mechanical manipulators which are ex¬ 
pressed as 

M(q)q + C(q , q)q + G(q ) + T^(t) T(t) (47) 

In the aim of developing a C\ adaptive controller for the class of systems 
given by (47), introduce the following combined position-velocity tracking error 
given by 

r = (q ~ qd) + A (g - q d ) 

where A G M 4x4 is a symmetric positive-definite weighting matrix. 


(48) 
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5.1. Control Law 

Consider the following control input vector T(t) consisting of a combination of 
two distinct terms [39] 

r (t) = r m (t) + r ad (t), r m (t) = A m r(t ) (49) 

where T m G l n is a state-feedback term characterizing the desired transient 
response of the tracking error r{t) and T a d is the adaptive control term which 
will be designed subsequently. Taking the first time derivative of (48) with 
respect to time we get 


r{t) = {q- q d ) + A (q - q d ) 


(50) 


Substituting the control law (49) into the dynamics of the parallel manip¬ 
ulator in (47) and solving for q along with substituting into (50), we get the 
following error dynamics 


r(t) = A m r(t) + T ad (t) r(0) = r 0 (51) 

where £ = [r, q] T and rj(t, ((t)) is a nonlinear function that gathers all the 
nonlinearities of the system including possible external disturbances. Before 
proceeding to the development of the adaptive control law, some important as¬ 
sumptions and properties regarding the unknown function have to be 

made, they can be summarized as follows 

Assumption 4. (Uniform boundedness ofrj(t, 0)) There exist B > 0 such that 

Vf > o, \\r](t, 0)||< B. 


Assumption 5. (Semiglobal uniform boundedness of partial derivatives of 

77(t,£(t))) The unknown nonlinear function A continuous with re¬ 

spect to its arguments, and for arbitrary 5 > 0, there exist d Vt (S ) and d Vx (S ) 
such that 


dyjtyi 

dt 


— dr/ t (* 5 ) > 


dyjty) 

d( 


— d Vc (S) 


(52) 


Assumption 6. for t > 0, WrtW^ < p and ^ for some positive 

constants p and d r . 
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It follows from Lemma A.9.2 in [38] that the unknown nonlinear function 
rj(t , ((£)) can be parametrized as follows 

=0(t)\\r t \\ Coo +cr{t) (53) 

where 6(t),cr(t) G are continuous, piecewise-differentiable and uniformly 
bounded unknown functions. Therefore, the error dynamics in (51) can be 
rewritten as: 

r(t) = A m r(t)+ T ad {t) - (e^WnWc^ + cr(t)), r( 0 ) = r 0 . (54) 

Notice that the substitution of T a ^ (t) = (0{t)\\r t \\ Coo +(j(t)) in the er- 
ror dynamics in (54) results in the desired performance characterized by 
r{t) = A m r{t). However, since the nonlinear function r](t,((t)) = 

(O^WrtWcoo + cr (^)) is unknown due to uncertainties and unmeasured distur¬ 
bances, the control term T a d(t) should be designed in a way that it estimates the 
unknown functions 6{t) and a(t) in real-time. 

5.2. State Predictor 

To predict the behavior of the combined tracking error r{t) and according to 
the C\ adaptive control theory, a state predictor that mimics the behavior of the 
error dynamics in (54) is formulated by [39]: 

r(t) = A m r(t) + T ad (t) - (<9(*)||^i|| J Coo + ^V)) “ Zf(t), f(0) = r 0 (55) 

where r(t ) is the state of the predictor, r(t ) = r (t) — r(t ) is the prediction 
error and 0{t),cr{t) are estimates of 0{t) and a(t ), respectively. Notice the 
introduction of the additional term Zr(t) responsible of rejecting the estimation 
error. 


5.3. Adaptation Laws 

The evolution of the adaptive estimates 9(t),a(t), required for the C\ adaptive 
control architecture, is governed by the following projection-type adaptation 
laws 

Q{t) = HProj (0(t),Pr(t)\\r t \\cC) > 

cr{t) = HProj ( a(t),Pr(t )), 


0(0) = 0 O (56) 

<r(0) = a 0 (57) 
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Figure 10. Block diagram of C\ adaptive control for parallel manipulators. 


where S > 0 is the adaptive gain, P — P T > 0 is the solution to the algebraic 
Lyapunov equation A^P + PA m = — Q for some arbitrary matrix Q = Q T > 
0 . 

Finally, the adaptive control term T a d(t) in (49) is given by its Laplace form 
as follows 

TadOO = C{s)fj(s) (58) 

where r)(s) is the Laplace transform of fj(t) = ^(f)||?’t||£ 00 + <r(tand C{s) 
is a diagonal matrix whose elements are bounded-input bounded-output stable 
strictly proper transfer functions satisfying C(0) = I n and zero initialization for 
their state-space realizations. 

To sum up, the block diagram shown in Figure 10 illustrates the architecture 
of C\ adaptive control for the class of systems given by (47). 


6. Extended £\ Adaptive Control of Parallel 
Manipulators 

Let qd(t), qd(t), qd(t) € M 4 be the desired joint position, velocity and accel- 
eration trajectories respectively. These reference trajectories to be tracked by 
the active joints of Veloce, are generated in task-space according to a specific 
task of the moving platform (e.g. pick-and-place). Then, adequate kinematic 
relationships are used to compute the corresponding joint quantities. The con¬ 
trol objective is to ensure that the traveling plate of the manipulator tracks, as 
accurately as possible, the desired trajectories regardless of any inherent non- 
linearities or external disturbances. To quantify the control objective, consider 
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the combined joint tracking error r[t) E M 4 defined by 

r(t) = (q - q d ) + A (q - q d ) (59) 

where A e M 4x4 is a symmetric positive-definite design matrix. Since —A is 
Hurwitz, it follows that (59) is BIBO-stable; i.e. there exist L \. L 2 > 0 such 
that [40] 

\\qr\\c 00 < L i\\r T \\c 00 + L 2 (60) 

where ||(.)r||£oo denotes the truncated £oo-norm of (.). The proposed control 
law to achieve the desired tracking performance is given by: 

T = Mo(qd)qd + Co(qd, q d )q d + Go(qd) + A m r + (61) 

The proposed control law in (61) can be thought of as the combination of 
three distinct terms. Each term has a specific role in the closed-loop system: 

• The first term (i.e. M 0 (q d )q d + C 0 (q d , q d )qd + G 0 (q d )) is a nominal feed¬ 
forward inverse dynamics term intended to minimize the effect of the 
inherent nonlinearities of the system and hence, to improve the tracking 
performance. 

• The second term (i.e. A m r) consists of a stabilizing state-feedback term 
specifying the desired closed-loop behavior of the system. 

• More importantly, the last term T a d , which will be detailed in the subse¬ 
quent development, is the adaptive signal responsible of rejecting all the 
remaining disturbances such as friction effects, external disturbances, etc. 

Substituting the control law (61) into (29) results in the following error dynam¬ 
ics 

r(t) = A m r(t)+ T ad (t) r( 0 ) = r 0 (62) 

where r/(t,((t)), ( = [r T , q T , q T ] T is a nonlinear function that gathers all the 
remaining nonlinearities that result from applying the control law (61) to (29) 
and is given by 


= M~ 1 (q)(M(q)q d + N(q, q)) 
+ (l-M-\q))(A m r + T AD ) 
- Ar + A 2 (q-q d ) 


(63) 
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where M(q) 4 M(q) - M(q d ), N(q, q) 4 JV(g, g) - N(q d , q d ) and I G M 4x4 

denotes the identity matrix. For the subsequent parametrization of 77 (£, £(£)), 
let’s consider the following non-restricting assumptions [41] 

Assumption 7. There exist positive B such that ||^(t,0)||< B holds for all 
t > 0. 


Assumption 8. rj is continuous in its arguments, and for arbitrary 5 > 0, there 
exist d m ( S ) and d Vx (5) such that 


drjjtX) 

dt 


— d'nt ( 4 ); 


drjjt, C) 
d( 


— d V( (S) 


(64) 


Assumption 9. for r > 0, HtyH^ < p and HtvII^ < d r , for some positive 
constants p and d r . Now, for some arbitrary 7 > 0, let 


p = max {p + 7, L\ (p + 7 ) + L 2 } , L p = -d v (p ) (65) 

P 

It follows from Lemma A.9.2 in [41] that 77 (£,£(£)) can be parametrized as 
follows 

= 0(t)\\r T \\ Coo + a(t) ( 66 ) 

where 0(t),a(t) G M 4 are differentiable functions. It follows that (62) can be 
rewritten as 


r{t) = A m r{t) + V AD (t) - ( 6 >(t)||r T ||£ oo + a(t)) , r( 0 ) = r 0 (67) 

Since the nonlinear function r](t,£(t)) is unknown due to uncertainties and un¬ 
measured disturbances, the control term T a d(t) should be adaptively designed 
in order to obtain estimates of 6{t) and cr(t). Now, consider the following state 
predictor of the combined tracking error 

r(t) =A m r(t ) + r ad {t) - ^(f)||r T ||£ oc + <r(i)) 

— Kr(t), f (0) = r 0 

where f(t) = r(t ) — r{t) and K G M 4x4 is a design parameter introduced to 
reject high-frequency noise [14]. 6{t) and a(t) are real-time estimates of 6{t) 
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and cr(t) respectively, their evolution is governed by the following projection- 
based adaptive laws in order to ensure their boundedness [41] 

0{t) = EProj (#(£), PrV)IK ll-Cco) > #(0) = (69) 

a(t) = EProj Pr(t )), <r(0) = <7 0 (70) 

where S G M + is the adaptive gain, P = P T > 0 is the solution to the algebraic 
Lyapunov equation A^P+PAm = —Q for some arbitrary Q = Q T > 0. Since 
the estimated parameters are bounded thanks to the projection operator, they 
satisfy ||0(£)||oo < #6, ||<t(£)||oo < cr^, Vt G [0,T]. The adaptive control 

signal Y ad (t) is the output of the following system given in Laplace domain 

r ad(s) = C(8)fj(s) (71) 

where fj(s ) is the Laplace transform of fj(t ) = (o^WrtWcoo + an d C(s) 
is a diagonal matrix of filters whose elements are BIBO-stable strictly proper 
transfer functions satisfying a unity DC gain and zero initialization for their 
state-space realizations. 

7. Real-Time Experiments and Results 

In order to demonstrate the relevance of the proposed extended C\ adaptive 
controller, real-time experiments were conducted on an experimental testbed 
consisting of the Veloce robot. 

7.1. Experimental Testbed of the VELOCE Robot 

The actuators of VELOCE are the TMB0140-100-3RBS ETEL direct-drive mo¬ 
tors. They can provide a maximum peak torque of 127 Nm and they are able 
to reach 550 rpm of speed. Each actuator is equipped with a non-contact incre¬ 
mental optical encoder providing a total number of 5000 pulses per revolution. 
The global structure of the manipulator is capable of reaching 10 m/s of maxi¬ 
mum velocity of the traveling plate, 200 m/s 2 of maximum acceleration and is 
able to handle a maximum payload of 10 Kg. The control architecture is imple¬ 
mented using Simulink from Mathworks and compiled using the XPC Target 
real-time toolbox. The resulting low-level code is then uploaded to the target 
PC; an industrial computer cadenced at 10 KHz (i.e. sample time of 0.1 ms). 
The experimental testbed is displayed in Figure 11. 
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Figure 11. View of the experimental setup of the VELOCE robot. 

7.2. Real-Time Experimental Results 

To demonstrate the relevance of the proposed contribution and to highlight its 
benefits, both the C\ adaptive controller in [16] and the proposed extended one 
were implemented in real-time on VELOCE. As a reminder, the implemented 
control law in [16] consists only of the stabilizing term and the adaptive term, it 

Table 3. Summary of the controllers’ parameters 


Parameter 

Description 

Value 

A 

position error weight 

10 x diag(65, 65, 65,65) 

Am 

transient response matrix 

diag(—6, —6, —6, —6) 

@max 

upper bound on 9 

50 

&max 

upper bound on a 

30 

E 

adaptation gain 

10 6 

K 

noise rejection gain 

10 3 x diag(6,6,6,6) 

C(s) 

C\ low-pass design filter 

144/ (s 2 + 21.6s + 144) 
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is expressed as 

T(t) = A m r(t) +T ad (t) (72) 

The traveling plate of the manipulator had to perform several spatial point-to- 
point displacements as well as rotations inside the manipulator’s workspace. 
We use 5 th order polynomials to generate the desired trajectories in Cartesian 
space, then the inverse kinematics problem is solved online to determine the 
corresponding joint trajectories. The duration of each point-to-point trajectory 
was fixed to 0.2 sec. The desired joint trajectories were obtained by solving 
the Inverse Kinematics problem in real-time while the actual ones are available 
from the encoders measurements. The manipulator is not equipped with ex¬ 
ternal sensors, hence the actual Cartesian position is obtained by solving the 
Forward Kinematics problem in real-time as well. We choose the same control 
parameters for both controllers, they are summarized in Table 3. The estimated 
functions were initialized to zero ((9(0) = [0, 0, 0, 0] T , <r(0) = [0, 0, 0, 0] T ). 

A comparison of the Cartesian tracking errors between both controllers is 
depicted in Figure 12. The plots are zoomed in the interval [5, 7] seconds for 
clarity. It can be clearly seen that the augmented controller performs much better 
than the original C\ adaptive controller especially on translations on the x and 
y- axes, while the enhancement is smaller on z-axis and the rotational DOF. 
To quantify the improvement brought by the proposed extended C\ adaptive 
controller, we formulate the following criteria based on the Root Mean Square 
(RMS) of the tracking errors: 


i 



RMS C = (RMS 2 (e x ) + RMS 2 (e y ) + RMS 2 (e 2 ) + + RMS 2 (e s )) * (74) 

where is the error between the desired and actual position and RMS(.) is 
the standard root mean square function. The obtained results are summarized in 
Table 4. It can be noticed that the improvement is very significant regarding the 
joint tracking errors (up to 52%) and the translational movements (up to 68.8%) 
while only small improvement is observed on the rotation of the traveling plate 
(only 4.2%). This result highlights the benefits of using the dynamics of the 
manipulator in the control loop in terms of tracking performance. 

The generated control inputs are shown in Figure 15. The control inputs 
remain within the allowable range and do not exceed the limits of the actuators. 
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— Extended £i-AC — Standard C\-AC 



5 5.5 6 6.5 7 



Time [s] 


Figure 12. Cartesian tracking errors: Extended C\ adaptive controller (solid 
line), C\ adaptive controller (dashed line). 


Overall, it can be observed that the amplitudes of the control inputs in the case 
of the augmented controller are slightly smaller than those of the standard C\ 
adaptive one. Hence, the following conclusion can be drawn: the proposed 

Table 4. Tracking performance comparison 



A-ac 

Extended A-AC 

Improvement 

RMSj [deg] 

0.1012 

0.0486 

52% 

RMSc [mm] 

0.4634 

0.195 

69.7 % 
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— Extended C\-AC — Standard £i-AC 



Time [s] 

Figure 13. Evolution of 6 versus time. 


controller significantly improves the tracking performance of the closed-loop 
system while consuming less energy than the standard one. 

The evolution of the estimated nonlinear functions 6{t) and d(t) versus 
time is depicted in Figure 13 and Figure 14 respectively. These figures clearly 
demonstrate the relevance of the proposed contribution. Indeed, the addition 
of the model-based feedforward considerably helps in compensating for the 
modeling inherent nonlinearities of the manipulator. Therefore, the remain¬ 
ing nonlinearities that have to be compensated for by the adaptive signal are of 
smaller amplitudes. This result is further illustrated in Figure 16 where only the 
evolution of the adaptive component of (61) and (72) are plotted (i.e r adit))- 
We can see that the adaptive signal, needed to compensate for the remaining 
nonlinearities, of the proposed controller is of lower amplitude than that of the 
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- Extended £i-AC — Standard C±-AC 



5 5.5 6 6.5 7 



5 5.5 6 6.5 7 



5 5.5 6 6.5 7 


Time [s] 

Figure 14. Evolution of a versus time. 


conventional one. 


Conclusion 

In this work, a new controller based on C\ adaptive control for parallel manipu¬ 
lators is presented. Standard C\ adaptive control do not rely on any knowledge 
about the dynamics of the controlled system which may result in a poor track¬ 
ing perfromance. Since a simplified dynamic model for parallel manipulators is 
relatively easy to derive, we propose to take advantage of the modelled dynam¬ 
ics in the control loop to enhance the performance of C\ adaptive control. For 
this reason, we augment the standard C\ adaptive controller with a computed 
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— Extended £i-AC — Standard £i-AC 
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Time [s] 


Figure 15. Evolution of the control input torques T versus time. 


feedforward term based on the nominal dynamics of the parallel manipulator 
and the desired trajectories. The main motivation behind such a proposition is 
to improve the tracking performance of the manipulator. In fact, the included 
dynamics partially compensates for the inherent nonlinear dynamics which re¬ 
sults in an improved tracking performance. Real-time experiments on a 4-DOF 
parallel manipulator show that the proposed augmented control scheme signifi¬ 
cantly reduces the tracking errors as compared to standard C\ adaptive control. 
Future work may consider evaluating the proposed controller in other working 
scenarios and on other parallel manipulators prototypes. 
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- Extended C \ -AC — Standard C \ -AC 



Time [s] 

Figure 16. Evolution of the adaptive control input torques I’,,,/ versus time. 
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1. Introduction 

Robots are a key element in current industrial processes, as they can be applied 
to a number of tasks, increasing both quality and productivity. Traditionally, se¬ 
rial robots have been installed in factories, as their wide operating space allowed 
them to fulfill a number of tasks. However, due to their high moving mass and 
single kinematic chain structure, these robots present some disadvantages when 
high speed, accuracy or heavy load handling tasks have to be executed. 

* Corresponding Author: asier.zubizarreta@ehu.es 
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Parallel robots [27] provide an interesting alternative to these applica¬ 
tion fields, as their multiple kinematic chain structure offers increased stiff¬ 
ness, allowing reduced positioning errors, lighter mechanisms and increased 
load/weight ratios. These capabilities make these robots suitable for those tasks 
where high accelerations and speeds, micrometric precision or heavy load han¬ 
dling are required. 

However, the complexity of their structure presents some drawbacks: com¬ 
plex kinematic and dynamic modelling, lack of closed-form solution in the kine¬ 
matic problem, presence of nonactuated joints, orientation and position cou¬ 
pling, limbs interference, small workspace and presence of inner singularities. 
These issues limit an extensive implementation of these robots in practical ap¬ 
plications in industry. Moreover, being a recently rediscovered field, there are 
still many areas in parallel robotics that have not been thoroughly studied. Thus, 
in addition to the aforementioned problematic, other challenges in areas such as 
control or calibration arise. 

The present work focuses on the control of parallel robots. Although less 
studied than areas such as kinematic analysis or synthesis, control plays an im¬ 
portant role in parallel robots [26], as it allows to extract the dynamic capa¬ 
bilities of the mechanical structure, ensuring that the design specifications are 
met in real robots. Moreover, parallel robots are usually implemented in tasks 
with high performance requirements where advanced control laws are required 
to fulfill the required specifications. Hence, research in this area is a central 
issue in parallel robotics. 

However, most of control approaches in parallel robotics have been im¬ 
ported from serial robots without considering the particularities of these robots. 
One of the main issues is that while control laws are easily defined in the joint- 
space in serial robots, in parallel robots the natural coordinates are the ones 
defined in task space [31]. These, which represent the pose of the mobile plat¬ 
form are not easily measured directly in the general case. Thus, it is common 
to use estimators based on the kinematic model of the robot, whose resolution 
is based on numerical procedures such as Newton-Raphson iterative approach. 
Moreover, in parallel robots some joints are not actuated, and their motion also 
has to be estimated. 

In this work, a solution based on the use of extra sensors attached to the un¬ 
actuated joints of the parallel robot is detailed. The extra information provided 
by these sensors can be used to implement a model-based control approach that 
combines the performance of advanced control techniques and the robustness of 
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sensor redundancy. In order to implement this approach, three major areas will 
be analyzed in the next sections: dynamic modelling, control law definition, and 
sensitivity, considering the well known Gough-Stewart platform as study case. 

2. Modelling Methodology Based on Extra Sensors 

2.1. Definition of the Dynamic Model in Parallel Robots 

In serial robotics literature, Lagrangian and Newton-Euler formulations have 
been widely used to calculate the dynamic model of n degrees-of-freedom serial 
robots [40]. 

r = D(q)q + C(q,q)q + G(q) (1) 

where x is the vector of the actuator torque/forces, q is the vector of the n articu¬ 
lar coordinates, D is the symmetric and positive-defined inertia matrix, C is the 
Coriolis matrix, where (D — 2C) is skew-symmetric and G is the gravity terms 
vector. Friction terms have been neglected in this model, although they can be 
introduced in it as an additional term easily. This model has been used in the 
literature to implement multiarticular model-based control techniques such as 
the Computed Torque Control approach [9]. 

The dynamic model of parallel robots can also be defined in the joint space 
as in Eq. (1), although some of the properties of the dynamic model do not 
hold, as the dynamic model is not defined in Direct Kinematic Problem singu¬ 
larities [23]. Being more complex than serial robots, the procedures applied to 
serial robots cannot be used in parallel robots directly, as constraints due to the 
multiple kinematic chains have to be introduced in the dynamic model. 

In the literature, three main approaches have been proposed to obtain the 
dynamic model of parallel robots: the traditional Newton-Euler formulation 
[10,14,18], which usually leads to a large number of equations due to the inter¬ 
nal forces of the mechanism; the Lagrangian formulation using Lagrange multi¬ 
pliers [5,20], which is an energetic approach and allows to eliminate the need of 
internal forces calculation; and the Principle of Virtual Work [12,41,43], which 
is also an energetic approach. When modelling a particular parallel robot, any 
approach can lead to a dynamic model as the one described in Eq. (1). 

However, these approaches require the knowledge of all kinematic variables 
of the robot in order to calculate the dynamic model of parallel robots. As the 
measurement of the end effector pose, this is, the Tool Center Point location, 
is not possible in the general case, the required kinematic variables need to be 
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estimated in terms of the actuated joints, which are usually sensorized. This ap¬ 
proach usually requires iterative procedures to calculate the estimated variables, 
and robustness of the estimation is based on the accuracy of the kinematic model 
parameters. 

In order to provide extra robustness to the approach and reduce compu¬ 
tational time, extra sensors can be introduced in specific passive joints. The 
advantages of the use of redundant data have been demonstrated in several 
works [3,25] to improve estimation accuracy or decrease kinematic model com¬ 
putational time. In this work, the use of explicit extra data in the dynamic model 
is proposed, so that this extra information can be used to increase control per¬ 
formance in model-based control approaches. This way, in the next section, an 
extended procedure is detailed to define the dynamic model of a parallel robot 
in terms of whatever generalized coordinates the designer selects, allowing to 
introduce data from extra sensors directly in the dynamic model. 

2.2. Dynamic Modelling Methodology for Full Parallel Robots 

The proposed methodology is based in two main ideas: the use of the La- 
grangian Formulation, which allows to define the dynamic model in terms of 
any set of generalized variables; and the use of a subsystem approach, in which 
the parallel robot is divided in the moving platform and the limbs, allowing to 
calculate the model of each part easily. It should be noted that the proposed 
approach is valid for fully parallel robots, i.e., robots in which the number of 
limbs are equal to the number of the degrees of freedom of the robot. These 
robots are very common in parallel robotic applications. 

In addition, the following considerations apply, which are common in gen¬ 
eral application cases: nondeformable elements are considered and friction 
terms will be neglected, although their introduction is straightforward. 

In order to illustrate the approach, the Gough-Stewart platform will be con¬ 
sidered as study case (Fig. 1). The Gough-Stewart platform is one of the most 
studied parallel robots, being composed by a moving platform and six UPS se¬ 
rial chains. This structure provides 6 degrees-of-freedom, making it suitable 
for tasks such as heavy load handling [37,44], high precision [28], underwater 
robotics [35], nuclear facilities inspection [34] and motion simulation [22]. 
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Figure 1. Gough-Stewart platform. 


2.2.1. Previous Considerations: Orientation Angles and Angular 
Velocities 

In the general case, for a 6 degrees-of-freedom motion, the output or task 
coordinates x contain the cartesian position of the Tool Center Point (TCP) 
p x = [ x y z ] , and the orientation angles ip = [ a (3 y ] of the moving 
platform with respect to the fixed frame 0(x,y,z), 

x=[xyzaPY] r (2) 

However, the choice of the orientation angles is arbitrary, and depends on 
the particular convention used. Hence, the time derivative of x only has physical 
meaning for the translation terms [2] in the general case, as the derivative of 
the orientation angles ip is not, in the general case, the angular velocity of the 
moving platform, ip ^ u. 

Hence, as the dynamics of rotational motions are described in terms of the 
angular velocity u but traditionally orientation is defined in terms of Euler an¬ 
gles ip , both variables should be related if a general case is to be considered. 
This relationship can be derived as [9], 

w = RR r (3) 

where R (ip) is the rotation matrix of the moving platform with respect to the 
fixed frame, R (ip, ip) is its time derivative and Cb is a skew-symmetric matrix 
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related to a;, 
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(4) 


Eq. 3 can be rewritten in the following form, depending on the selected 
Euler angle convention, 

i~ * 

a? = = E 


p 

L y J 


(5) 


where E depends on the selected Euler angle convention, and will be illustrated 
for a specific case in the next subsection. 

Hence, if a velocity vector v is defined in terms of the angular velocity terms, 


v 


Px 

Cc? 


( 6 ) 


then, x and v can be related as, 

v= 0 e * =Tr * (7) 

where Tr( / 0) is a projection matrix defined in terms of the selected Euler an¬ 
gles. 

Based on this expression, and taking the time derivative, the angular accel¬ 
eration and the second time derivatives of Euler angles can be related, 


a = v = 


Px 

Co 


Trx + T r x 


( 8 ) 


where Tr(' 0, depends on the Euler angles and their derivatives. 

Eqs. 7 and 8 will be used in the next section to define the dynamic model of 
the robot. 


2.2.2. Subsystems and Variable Sets 

A parallel robot is composed by two platforms, a fixed one and a moving one, 
connected by several serial links (Fig. 1). If a fully parallel robot is considered, 
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such as the Gough-Stewart platform, the number of serial chains or limbs is 
equal to the number of degrees-of-freedom (dof). 

In order to calculate the dynamic model of the robot, the usual approach 
is to consider the parallel robot as a group of independent subsystems that are 
connected using kinematic constraints. Thus, two subsystems are considered: 
the moving platform, where the TCP is located, and the serial chain subsystem, 
i.e, the limbs. The dynamic model of each subsystem can be calculated easily 
in terms of its natural coordinates. This way, the motion of the moving platform 
can be easily defined in the task space in terms of the n — 6 output coordinates 
x=[xyz oc (3 y ] , while the dynamics of the serial limbs can be cal¬ 
culated using serial robot approaches, which are based on the use of n q = 18 
joint variables q. 

Joint variables can be divided in two sets: actuated and nonactuated joint 
variables, 

€ M 18 (9) 

The n — 6 actuated joints q a , are associated to the prismatic actuators of 
the Gough-Stewart platform, which are composed by a cylinder and a rod, and 
whose relative motion varies the q a . = /; distance between points Ai and Bi for 
each i = 1,... 6 leg (Fig. 2). 



q a = [ /] h h U h kf (10) 

Nonactuated joint variables q na , on the other hand, are not actuated although 
their motion is required to be known in order to calculate the dynamic model of 
the robot (Fig. 2), 

' 9 

qna ~[ ( f 

where, 9 = [ 0 i 02 63 64 65 06 ] T and p = 

[ (pi (p 2 93 94 95 96 ] T ■ 

In this work, the introduction of sensors in a subset of the nonactuated joints 
is considered. Hence, the joint variables in the nonactuated joint variable set 
can be divided in n s sensorized q s and n p passive q p joint variables, q na = 
[ Qs 7 Qp 7 ] T • This way, the set of sensorized and measurable n c = n + n s 


>12 


( 11 ) 
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Figure 2. Closed loop kinematic equation. 


joints will be denoted as control coordinates q c (Fig.3), 


q c = 



G R nc 


where n c G [n, n q ], depending on the number of extra sensors introduced to mea¬ 
sure the variables in q na . 


2.2.3. Kinematic Model 

In order to define the dynamic model of the Gough-Stewart platform, its kine¬ 
matic relations have to be calculated first. 


Closure Loop Equation. The six vectorial closure loop equations are de¬ 
duced from the mechanical structure of each limb and its connection to the fixed 
and moving platform, as seen in Fig. 2. This way, if 0(x,y,z) is the fixed refer¬ 
ence frame, attached to the fixed platform, the equations defining the motion of 
each limb can be written as follows, 


ri = ai + li-p x -di° = 0 6 


( 12 ) 
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Figure 3. Variables in the dynamic modelling methodology. 


where p x = [ x y z ] 7 is the cartesian position of the TCP of the robot, which 
is the origin of the moving frame; ai is the constant position vector of the U 
joints located in Bi, which define the geometry of the fixed platform and li is the 
vector that represents the relative position of Ai with respect to Bi, and it is de¬ 
fined in terms of the joint variables associated to the limbs qi = [ l\ 0 Z cp z ] , 


li = U 


COS0 z COS(p z 

sin0 z cos(p z 

sinq); 


(13) 


The orientation of the moving platform is given by d[°, which is the projec¬ 
tion of the constant vector di defined in the moving reference frame P(w,v,w) 
with respect to the fixed one, 


d i ° = R(a,(3,y)d i 


(14) 


where if roll-pitch-yaw (a, (3, y) angles are selected to define the orientation, 


R(a,p,y) = 


cyc(3 

yycP 


cy^p sa — syca sysa + cy^p ca 
cyca + vy^p sa yy^p ca — cysa 
cP^a cPca 


(15) 


where c and s stand for the trigonometric functions cosine and sine, respectively. 
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Note that each closure loop equation is defined using two sets of variables, 
the output ones x, and the joint variables associated to each limb qi. The com¬ 
bination of the closure loop equations 12, defines the constraint equation set of 
the robot, that relates all variables, 

[r<(x,qi)],-^ 6 = r(x,q) = Oisxi (16) 

Inverse Kinematic Problem. The Inverse Kinematic Problem (IKP) allows 
the calculation of the active joint variables q a in terms of the output ones x. 
Thus, if x is known, the cartesian position of Bj = p x + Rdi can be determined 
easily. Hence, imposing the distance constraint if = | |lj| | 2 on the vectorial loop 
closure equation Eq.12 and operating, 

if = li r li = [Px -ai + R(a, p, y) di] r [p x - a t + R(a, P,y) dj i= 1...6 (17) 

Position Problem for Nonactuated Joints. The nonactuated joint variables 
define the position of the elements of each serial chain. Hence, if vector lj 
associated to each limb is considered and Eqs. 12 and 13 are combined, 

/; cos 0/cos (p/ 

li = Px-ai+/?(a,(3,y)di = /; sin0;coscp; (18) 

li sincp/ 

Considering q a and x known, each nonactuated joint variable can be calcu¬ 
lated for i = 1,... 6, 

cp/ = atari 2 (l iz , y/lf x + if^j 0/ = atan2(l iy ,l ix ) (19) 

Direct Kinematic Problem. The Direct Kinematic Problem (DKP) calculates 
the pose of the moving platform x in terms of the actuated ones q a , whose actua¬ 
tors are usually sensorized. This relationship is of great importance in robotics, 
as x cannot be directly measured in the general case, and its estimation is re¬ 
quired. However, this estimation is usually time consuming, as no analythical 
solution exists in the general case for the DKP. Moreover, the estimation pro¬ 
vided by the DKP is highly dependent on the accuracy of the kinematic param¬ 
eters of the robot. 

Redundant sensors can be used to enhance the calculation procedure of the 
DKP [25,32] and add more robustness. This way, if a subset of the nonactuated 
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joints are sensorized, q s , this data can be used to get a better estimation of the 
output variables. 

For this purpose, a selection vector I c is defined. This vector contains the 
indexes of the variables of q that are sensorized, considering that active ones q a 
are always in this set. Hence, the set of control variables q c can be defined, 


qc = [q]i c (20) 

Hence, two sets of equations can be used to estimate x. First, if Eq.17 is 
considered, x and q a can be related, 

[||li( x )|| — z ?]. =1 6 = 0 6xl ( 21 ) 

On the other hand, the sensorized nonactuated joint variables defined in Eq. 
19 can be also used to estimate x, 


|4(x, q a ) tan 0,- - l iy (x, q a ) 

\A'x( x i q a ) 2 +(ry( x ) q a ) 2 ta n( Pi - //-( x - q a ) 

Combining Eqs. 21 and 22, a 18 equation system can be defined, each 
relating a variable from q with the output variables, F = Oigxi, 


i= 1...6 = °6xl 

= 06x1 


( 22 ) 


f=1 6 


F(x,q) = 


[mil 6 

[hx tan0/ — hy\f = i ft 
+ tan cp, — l iz __ 


= 0i8xl 


(23) 


Hence, selecting the sensorized variables using I c , the equation system re¬ 
lation all measurable variables q c and x can be obtained, 


F c (q c ,x) = [F(q,x)]i c = 0 


(24) 


which, as q c is known, defines the redundant DKP solving approach, 


Velocity Problem. In order to calculate the velocity relations of the robot, the 
vectorial Closure Loop equation for each limb Eq. 12 has to be differentiated 
with respect to time, 

ii = Px + Rdi = p x +ct? x Rdj = p x — Rdi x u ; (25) 
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where, Rdj = dp, defined in Eq. 14, satisfies dP = Rdj R r . Hence, the previous 
equation can be written as, 

ii = p x -RdjR r cc>= [ I 3x3 —RdjR r ] v (26) 

As seen in Section 2.2.1, 

ii = [ I 3x3 —RdiR r ] T r x (27) 


where, if roll-pitch-yaw angles are used, Tr can be calculated (Eq. 7), 


Tr 


I 0 
0 E 


and, 


E = R 

Combining Eqs. 27 and 28, 
it = [ I 3x3 —RdjR r ] Tr x = — 

'-V-' 

Jx ; 


1 0 — sin (3 

0 cos a cos P sin a 

0 —sin a cos P cos a 


(28) 


(29) 


—C(p;C0; // C 9/ .V 0/ // C 0/ .V 9/ 

— C* CP/ A 0/ —Z/CCP/C0/ l{ $ 9/ S 0/ 

-S% 0 — Z/ccp/ 

-V- 


qt 


(30) 


Hence, the link velocity equation can be written in matrix form, 


JxjX— Jqi qi (31) 

where qi=[/; 0/ <p; j 7 . 

Operating, the link Jacobian matrix associated with the serial chain i being 
Ji can be calculated, 

~JqiQi~Jx{^ ^ Qi — ~ Jqi Jxj ^ = (32) 

3x3 3x6 3x6 

All velocity relations can be deduced operating Ji. Note that each row of Ji 
is associated to a joint variable contained in qi. Hence, if [A]/ is defined as the 
row operator that extracts the i -th row of a matrix A, 

q a = Jq a x Jq a = [ [Jiff ... [J 6 ff ] T 

qna = Jq„ a X Jq na = [[Jiff ... [J 6 ff [Jiff ... [J 6 ]ff ] ^ 

(33) 
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and combining both active joint Jacobian J Qa and nonactuated joint Jacobian 
Jq na , the joint variables Jacobian J q can be calculated, 


q = 


q a 


i 

5-H 

to 

_1 

4na 


1 

5-H 

hfi 

§ 

i_ 



18x6 


(34) 


If only the control coordinates are considered, the control coordinates Ja¬ 
cobian J qc can be calculated by combining the rows of J q that are related to 
sensorized (vector I c ) joint variables, 

q c = [Jq] lc x = Jq c X ^ X = J qc f q c (35) 

where ,I (|i ' is the Moore-Penrose generalized pseudoinverse of the Jacobian ma- 
trix associated with the control coordinates. 

The rows not included in J qc , are associated to passive joint variables that 
are not sensorized nor actuated, hence, the passive variable joint Jacobian can 
be defined as, 

q P = Jq p x (36) 

The relationship between the velocity of all joint coordinates q and active 
ones q a is required to calculate the dynamic model of the robot, and can be 
calculated based on previously calculated Jacobians, 


i T 


L JqnaJqa 


-1 


4a — t q a 


(37) 


Finally, if control coordinates are to be considered, the relationship between 
velocity of all joint coordinates q and control coordinates q c , 


4 — Tq q c , [T q ]. — 

18 xn c 


e/, qi = q Cj € q c 
[Jq p Jp] /c ^ q; = q Pk € q p 


(38) 



where 


1 , i = j 
0, i 7 ^ j 
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Acceleration Problem. Acceleration relationships can be calculated by dif¬ 
ferentiating the link velocity equation Eq. 32 with respect to time, 


Qi — Jqi J Xi X Jqj (jxi+JqiJi)x 
(ji = JiX + JiX 


(39) 


If the procedure defined for velocity relations is followed, the acceleration 
Jacobian associated to the joint variables J q can be calculated, 


q 

q 


CT 1 

•"■5 1 

x + 

Jq a 

_ Jqna _ 

L Jqna 

JqX +j, 

1* 



(40) 


Similarly, if control coordinates are considered and the associated rows se¬ 
lected from the previous equation, 

qc — Jq c X + jq c X > X = Jq c ^ (jc — Jp Jq c Jp4c = Jp + Jp 4c (41) 


Finally, considering the time derivative of matrix T q , 
q — T q q c + T q q c 


(42) 


18 xn c 


18 xn c 


2.2.4. Dynamic Model 

As stated previously, a subsystem approach will be used to calculate the dy¬ 
namic model. Hence, the dynamic model of the moving platform and the limbs 
will be calculated independently in terms of their natural coordinates. 

The Lagrangian formulation with multipliers will be used, as it provides the 
possibility to define the model in terms of any set of generalized coordinates. 
For that purpose, the Fagrangian of the robot L has to be calculated in terms of 
the kinetic Kmp, Ks and potential Ump, Us energies of each subsystem, 


L = (K mp - U M p) + (K s - U s ) (43) 


The calculation of these terms will be detailed for the Gough-Stewart plat¬ 
form next, 
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Kinetic and Potential Energies of the Moving Platform The moving plat¬ 
form is considered a free body rotating and translating in space with mass m p 
and a centroidal inertia I p . Its center of mass (CM) is located in the origin of the 
moving reference frame P(w, v, w) (Fig. 1). As the TCP is located in the moving 
platform, the mass of the load m c and its inertia I c have to be considered in its 
dynamic model. 

This way, if the energy of free motion in space is considered, 


K M p = 3Px Px(m p + m c ) + ^u> T (I p + I c ) u 
Taking into account Eq.7, 


(44) 


Kmp = h x r Tr T 


(m p +m c ) I 3 0 3 

®3 Ic + Ip J 


TrX 


(45) 


= ±x r M x (x)x 


6x6 


being M x (x) the inertia matrix of the moving platform, defined in terms of x. 

The potential energy of the platform is related to its relative position with 
respect to the fixed frame, 


U M p = ( m p +m c )gz 


(46) 


where g is gravity vector. 

Kinetic and Potencial Energies of the Limbs Each of the limbs connecting 
the moving platform and the fixed base are structurally identical, being their 
parametric model identical. Each serial chain is a polar serial robot, presenting 
3 dof associated to the link joint variables qi = [ /; 0/ (p; ] (Fig. 2). As 
seen in Fig. 4, the serial chain is composed by two elements: a cylinder of mass 
m/i,attached using a universal joint to Ai, and a rod, of mass ma , which has a 
prismatic motion with respect to the cylinder, and is attached to point Bj. 

The center of mass (CM) of each cylinder is calculated in terms of the non- 
actuated joint variables, 


l c i l COS 0/ COSCp i 
l c i x sin0; coscp/ 
4/1 sin (p/ 


CM/i — ai + 


(47) 
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Ai 

Figure 4. Limb parameters. 


Differentiating this expression with respect to time, the linear velocity of the 
CM of each cylinder can be calculated, 


Vil = 


acMii 

3q 


q = E Vll q 


(48) 


where E Vil is the Jacobian that relates the linear velocity of the CM to the deriva¬ 
tives of the joint variables. 

The angular velocity of the CM of the cylinder, uon , can be calculated by 
projecting the velocity vectors associated to the nonactuated joint variables 0j 
and (ft in a moving frame attached to the CM of the cylinder, 


CJ /1 = [ 0; sincp; — <P; 0/ COSCp/ 


(49) 


If the terms are rearranged in terms of q, 


W l = E^ q (50) 

where E^., is the Jacobian matrix that relates the angular velocity to the deriva¬ 
tives of the joint variables. 
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01 




Figure 5. Cylinder rotation. 


Once defined the velocities for the cylinder, the kinetic energy expression 
can be calculated, 

Ksn — — q r ( m i\ E Vil T E Vil + Eco-j T Iii E^.,) q = — q r M Sil q (51) 

where M Sil is the inertia matrix of the cylinder. 

The kinetic energy of the rod can be calculated following the same proce¬ 
dure. First, the position of the CM is calculated in the fixed frame, 


CM/2 — ai + 


(// — l c i 2 ) COS 0/ COS Cp i 
(// — l c i 2 ) sin 0/ cos cp/ 
Hi - Ich) sin cp, 


(52) 


Differentiating this expression with respect to time, the linear velocity of the 
CM of each rod can be calculated, 


Vi2 = 


acM i2 . 

^r q= 


Ev 12 4 


(53) 


where E v . 2 is the Jacobian that relates the linear velocity of the CM to the deriva¬ 
tives of the joint variables. 

On the other hand, as the relative motion of the rod with respect to the 
cylinder is a pure translation, the angular velocity of the rod will be the same as 
the one of the cylinder, 


where E Wi2 


= E 


W,-l 


u > i2 = u>ji = E^ q 


(54) 
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Hence, the kinetic energy of the rod, 

Ks i2 = 2 ^ ( m /2Ey i2 E Vi2 +E w . 2 IqE^) q = — q M Si2 q (55) 

The potential energy of both the cylinder and the rod can be calculated con¬ 
sidering the z coordinate of their CM position, 


U Si i = mngl cil sincp; 

U Si2 = mi 2 g ( li - lci 2 ) sincp/ 


(56) 


Thus, the total kinetic and potential energies of this subsystem is calculated 
considering all limbs, 

6 6 j 

= £^,, + £^ a = -q r M s q 

I 1 I 1 6 (57) 

Us = u sn + T Us i2 = L ( l i - l ch ) + m n lei ! ]g Sin cp ; 

/=1 Z=St| 1=1 


6 

where M s = ^ (M Sil +M Si2 ) is the total inertia matrix of the serial chain sub- 

i= 1 

system. 


2.3. Dynamic Model 


Once defined all energies, the Lagrangian of the robot can be calculated, 

L = {Kmp ~ Ump) + (K s — Us) = L^(q,q) +L M p(x,x) (58) 


Note that the Lagrangian associated to the serial chains is defined only in 
terms of the joint variables, while the Lagrangian of the moving platform is 
defined in terms of the output coordinates. These coordinates sum a total of 
n + n q = 24. However, only 6 are independent, as the robot provides only 6 
dof. Hence, a set of 18 constraints have to be applied to solve the model. By 
using the Lagrangian Multiplier formulation, these constraints can be implicitly 
introduced by using a set of 18 multipliers. 

This way, if the formulation is applied to each subsystem, two vectorial 
equations can be obtained, 


d _ /3LA 

dt \dqj J dqj 

d (dLjwp \ dL p 

dt \ dik J dxk 




i= 1 


dr,-(x,q) 

dqj 

5lVx,qi) 

dx k 


^qjJ= 1,18 
, k = 1,...6 


(59) 
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where x CJj are the virtual torques associated to each joint variable in q, if all 
were actuated, and r*(x,q) is the vectorial loop equation for each kinematic 
loop (Eq.12). 

Operating on the left part of the equation system, and rearranging, the clas¬ 
sical structured form of the dynamics of robots can be defined, 


D x x + C x x + G x 

D s q + C s q + G s 


drp,q) 

dx 

drp,q) 

dq 


T 

T 


A 

A + 7V 


(60) 


where D x , C x and G x are the inertia, Coriolis and gravity terms associated with 
the mobile platform, and defined in terms of x, D s , C s and G s are the inertia, 
Coriolis and gravity terms associated with the legs, defined in terms of q, A is 
the vector of the Lagrange multipliers and [x r J lg — r r . 

Combining both equations, Lagrange multipliers can be eliminated, 


T r 


D s q + C s q + G s 



(D x x + C x x + G x ) 


(61) 


and considering that T(x, q) = 0ig x l is the set of all constraints of the robot (Eq. 
16), the constraint Jacobian Jc = dx/dq can be defined, 

T r — D s q + J J D x x + C s q + J J C x x + G s + J J G x (62) 

However, as previously stated, r r is the set of virtual torques associated with 
all joint variables in q. In parallel robots, only the actuated set q a has an actuator 
attached and can provide torque, hence, the model needs to be projected to the 
actuated space using the Jacobian defined in Eq. 37 [29], 

T q a = T r r r = T r D s q + T r jJ D x x + T r C s q + T r jJ C x x + T r G s + T r jJ G x (63) 
where it can be easily demonstrated that T t Jq T = [Jq a _1 ] r > 

T qa = T r D s q + D x x + T r C s q+ [j q ~ l ] T C x x + T r G s + [j qa ~ l ] T G x 

(64) 


The previous equation defines the dynamic model of the robot in terms of 
all variables. If the redundant data is to be used to feed the dynamic model, the 
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model can be rewritten in terms of q c in compact form using the velocity and 
acceleration expressions defined previously, 

T q a ~ Di ic + Cq c + G (65) 


where 

D = T r DqT q + [jq a -1 ] r D X J P 

c = T r (Dq T q + C q T q ) + [Jqa _ !] ^ (D x j p + C x J p ) 

G = T r Gq+[j qa - 1 ] r G x 

which defines the dynamic model of the robot in terms of any set of control 
variables q c , which can include any set of sensorized variables. Note that the 
matrices of the model are not regular, as the model is fed with more information 
than strictly needed. This will be the basis of the Extended control approaches 
analyzed in further sections. 


2.4. Model Validation 


In order to validate the approach, a particular case will be analyzed. The works 
of Wang and Gosselin [43], Tsai [41] and Guo and Li [14] have stablished a 
well-documented study case that provides all the required data for proper model 
validation. Hence, the redundant model results will be compared with the ones 
of these works in order to validate the approach. 

The particular Gough-Stewart platform parameters used are shown in Table 
1 , and have been extracted from the aforementioned works. 

The reference trajectories proposed by these authors are detailed next. The 
first one is a constant orientation trajectory, where a = (3 = y = 0 and 


Px = 


— 1.5 + 0.2 sin cor 
0.2 sin cor 
1 +0.2 sin cor 


where co = 3 rad/s and cor = [0, 2n\. 

The second trajectory is a constant position trajectory p x = 
[ —1.5 0 1 ] r , where platform rotates with respect to the fixed z axis: 
a = (3 = 0 and y = 0.35 sin cor with co = 3 rad/s and cor = [0, 2n\. 

Using the dynamic model detailed in Eq. 65 the torques r qa required to ex¬ 
ecute these trajectories have been calculated for the case in which all joint vari¬ 
ables are sensorized, this is, q c = q. The obtained results can be seen in Figs. 
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Table 1. Dynamic and kinematic parameters (/ = 1,.. .6 limbs) 


Parameter 

value 

ai 

[-2.12 1.374 0 ]' (m) 

a2 

[-2.38 1.224 0 ] T (m) 

a 3 

[-2.38 -1.224 0 ] T (m) 

a 4 

[-2.12 -1.374 0 ] T (m) 

a 5 

[0 -0.15 0 ] T (m) 

»6 

[ 0 0.15 0 } T (m) 

di 

[0.17 0.595 -0.4 ] T (m) 

d 2 

[-0.6 0.15 —0.4 ] T (m) 

d 3 

[-0.6 -0.15 —0.4 ] T (m) 

d 4 

[0.17 -0.595 —0.4 ] T (m) 

d 5 

[0.43 -0.445 —0.4 ] T (m) 

d 6 

[0.43 0.445 —0.4 ] T (m) 

hi 

0.5 (m) 

Ich 1 

0.25 (m) 

In 

0.5 (m) 

lci n 

0.25 (m) 

m p 

1.5 (kg) 

m c 

0 (kg) 

m n 

0.1 (kg) 

m a 

0.1 (kg) 

Ip 

0.081 3 (kgm 2 ) 

Iii 

0.006251 3 (kg m 2 ) 

Ii2 

0.006251 3 (kgm 2 ) 

Ic 

0 3 (kg m 2 ) 


6-7, and are identical to those obtained by Wang and Gosselin [43], Tsai [41] 
and Guo and Li [14] . Hence, for the same reference trajectories and model 
parameters, the redundant dynamic model yields the same results as those ob¬ 
tained by the cited authors. Moreover, any set of q c that includes at least the 
actuated variables q a yields the same result. 
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0 0.5 1 1.5 2 2.5 

Time(s) 


Figure 6. Forces for the constant orientation trajectory. 


3. Control 

3.1. Position Control in Parallel Robots 

In the control area of parallel robots, the main trend has been to import directly 
the control approaches from serial robots to parallel robots without considering 
the specific features of the latter ones. This way, most of the position control 
related works in the literature fall into two categories: local feedback control 
approaches and model based control approaches. 

Local feedback control approaches are based on the use of a local PID based 
controller to control each joint independently from the rest of the mechanism. 
In this group several approaches can be found: simple Proportional-Integral- 
Derivative (PID) loop based schemes [7, 16, 36], joint dynamic model based 
approaches [6,13], Proportional-Derivative (PD) plus gravitation compensations 
schemes [12,39] or nonlinear PID based control laws [30,38] fall into this group. 
In general, these approaches are easy to implement due to their simple control 
law. However, as they do not consider the dynamic coupling between the joints, 
they do not provide good control performance when high speed and accuracy 
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Figure 7. Forces for the constant position trajectory. 


are required. 

Model based approaches, on the other hand, require the dynamic model of 
the parallel robot to define the control law and provide better performance when 
high speed, accelerations and accuracy are needed. One of the most extended 
approach is the Computed Torque Control (CTC) scheme [1,8,11]. However, 
obtaining an accurate dynamic model is a challenging task, as simplifications 
are usually made and some phenomena, such as friction or backlash, are not 
considered. Thus, in order to ensure the dynamic performance of the controller 
in presence of model parameter uncertainties, some authors have also proposed 
robust [13,17,19,21] or adaptive control [15,33] approaches. 

From the results offered by the works in the literature, model-based schemes 
seem to be the best approach when high-speed and accuracy requirements must 
be met in parallel robots. However, the correct calibration of the dynamic model 
is difficult, as parameter identification errors arise, and their computational cost 
is higher than the simpler, local feedback controllers. 
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3.2. The Extended CTC Approach 

An interesting approach to increase control performance in parallel robots is the 
introduction of extra sensors in the nonactuated joints of the mechanism, so that 
the redundant data can be used to minimize the effect of parameter uncertain¬ 
ties and to implement a more efficient redundant control law in parallel robots. 
Although this approach increases the cost of the robot, the advantages of using 
redundant sensor data have been demonstrated by authors such as Merlet [25], 
Baron and Angeles [3], Marquet et al [24], and Bauma et al [4]. 

The Extended CTC approach is based on this idea [45]. This position con¬ 
trol scheme is based on a modified Computed Torque Control approach that 
makes use of the redundant dynamic model defined in Section 2.2. This way, 
the Extended CTC approach combines the performance of the classical CTC 
with the robustness of sensor redundancy, providing better trajectory tracking 
than the classical nonredundant CTC approach. 

The control law is defined as (Fig. 8), 

Tq a = D(q c , q p ,x) (q Cd + K v e qc + K p e qc ) + C(q c , q p ,x, q c , q p ,x) q c + G(q c , q p ,x) 

( 66 ) 

where K p and K v are the position and velocity matrix gains, e qc = q Cd — q c is 
the tracking error of the control coordinates and e^ c its time derivative, q Cd is 
the reference of the control coordinates, and D, C, G are the identified matrices 
of the dynamic model defined in Eq. 65 

This way, all the measurable variables contained in q c are used to fed the 
model, and in case of errors in model parameters, the controller tries to minimize 
not only the errors in active joints, but also the sensorized ones, achieving better 
dynamic performance. 

3.3. Extended CTC Control Validation 

The Gough-Stewart platform defined in Section 2.2 is used to validate the per¬ 
formance of the Extended CTC approach over the classical CTC scheme. For 
that purpose, the redundant dynamic model defined in Eq. 65 is calculated for 
the four different sensor configurations detailed in Table 2. As it can be seen, 
Configuration 1 corresponds to the classical CTC approach in which only the 
active joints are sensorized, while Configuration 4 corresponds to the case in 
which all joint variables are measured. 

A complex, high speed helicoidal trajectory defined in the non-singular 
workspace of the Gough Platform (Fig. 9) is defined to compare the dynamic 
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Figure 8. Extended Computed Torque Control. 

Table 2. Extended CTC Configurations 


Config. 

q c 

1 

fie = fia € ffi 6 

2 

qc=[qa r 0i 03 <Pi tp3] T eM 10 

3 

q c = [q a r <P r f GMl2 

4 

q c = q € M 18 


performance of the approach. This trajectory, defined in Eq. 67, allows the 
controller to be tested in a wide workspace area. 

0.4cos(10t) 

0.4 sin(10t) 

1.2 + 0.1592? 

Xref IOji/ 180 sin(12f) C ’ 

IOji/ 180 cos(12f) 

_ IOji/ 180 sin(12?) _ 

The model parameter set for the comparative analysis is the one detailed in 
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Figure 9. Helicoidal Reference Trajectory. 


Table 1 where, in addition, a load of mass m c = 1 kg and inertia I c = 0.06 13 
kgm 2 has been attached to the platform. Moreover, a friction term F r is in¬ 
troduced into the direct dynamic model to simulate the dynamics of the robot, 
which is not considered in the control law, 

F r = T r F y q + T r F c s/gft(q) (68) 

where F y is the viscous friction term and F c is the Coulomb term. The F y 
terms associated with the active joints q a are assigned a value of 0.83 kgm/s, 
and those associated with the non-actuated joints are assigned a value of 
0.09 kgm/s. Further, the terms of F c associated with the active joints q a are 
0.42 N , while those associated with the non-actuated joints are 0.05 N. 

The proportional K p and velocity K v gains have been tuned to obtain a max¬ 
imum overshoot of 5% and a peak time of 0.05 s in the classical CTC controller. 
The same gains are used for all controllers, and the cycle time is set to 5 ms. 

In order to carry out the comparative analysis, the Integral of the Absolute 
Error (IAE) performance index of the end-effector positioning and orientation 
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error, defined as f^\e(t)\dt, will be analyzed. Specifically, for the proposed 
reference trajectories the real end-effector coordinates x are measured and com¬ 
pared with the desired ones in order to calculate the tracking accuracy. In order 
to show the effect of parameter uncertainty in the performance of the controllers, 
the real robot parameters have been randomly modified from their nominal val¬ 
ues by a maximum value of 0.1 mm in distance parameters, 0.01 kg in mass 
parameters and up to the 10% in inertia terms. Five parameter cases have been 
considered, from 0% to 100% of theses maximum values. In order to obtain 
statistically relevant data, each simulation iteration and case has been repeated 
350 times using different parameter variations within the desired bounds and 
the average dynamic performance is considered as representative for a given 
controller. 

Results are summarized in Figs. 10 and 11. As it can be seen, the IAE 
error index increases with the parameter variation percentage, this is, errors 
increase as uncertainties arise. However, the relative increase is much lower 
when redundant data is used (Configurations 2, 3 and 4). 



Figure 10. Average positioning IAE. 

The relative performance also varies if different sensor configurations are 
considered. For instance, it seems logical to think that the more sensors used, 
the better the performance will be. However, this is not always straightforward, 
as Configuration 2 and 3 have very similar performance with different sensor re¬ 
quirements. Thus, it is clear that it is necessary to identify an appropriate sensor 
distribution in order to achieve the best performance and exploit the potential of 
the Extended CTC approach. 
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Figure 11. Average orientation IAE. 


As a more detailed example, is shown in Figs. 12 and 13 , where the error 
over time associated with the two TCP locations is shown for a case in which 
a helicoidal trajectory is followed and maximum errors are introduced in the 
nominal parameters. Configuration 1 and 4 are compared, being Configuration 
1 the equivalent of the classical CTC approach and Configuration 4 the one with 
all joint variables sensorized. If errors in the joint variables are considered, it 
can be seen that the classical approach provides better tracking in the active 
joints, as the controller tries to minimize these errors, while the Extended CTC 
seems to present higher errors in the sensorized joints, as errors are distributed 
among the measured variables. However, this error distribution provides better 
results in the task space, where Configuration 4 presents a smaller trajectory 
tracking. 

Thus, in summary, it has been demonstrated that the use of the redundant 
Extended CTC configurations can provide better performance than the classical 
CTC approaches even in the presence of model parameter errors and nonlinear 
phenomena such as friction. However, it is clear that in order to achieve the best 
results the sensor configuration has to be selected with care. 
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Figure 12. Time evolution of the TCP position and orientation error. 



Figure 13. Time evolution of joint variables error. 
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4. Sensitivity 

4.1. Sensitivity-Based Approach to Evaluate Sensor Configurations 

One of the central issues when implementing redundant sensor based ap¬ 
proaches such as the Extended CTC is determining the number and location 
of the extra sensors. This is an important step in the design of the mechanism, 
as the introduction of extra sensors is not a trivial task. Hence, determining 
how many sensors are needed and where are they located is very useful when 
designing passive joints. 

Note that the Extended CTC is defined in a general way in terms of q c . 
Thus, multiple sensor configurations can be used to implement it. Depending 
on the complexity of the mechanism, the number of possible combinations can 
increase significantly. 

In order to evaluate in an easy way the different sensor configurations for a 
given platform and task, a sensitivity based procedure is proposed. This analysis 
allows to determine the influence of the variation of each model parameter in 
the position of the TCP. Thus, if the sensitivity of all parameters for a given 
Extended CTC configuration is calculated, a measure of the relative robustness 
to model parameter uncertainties can be obtained. Hence, if different Extended 
CTC configurations are analyzed, an insight into the relative robustness of each 
configuration can be calculated, so that the most suitable sensor distribution can 
be selected for a given robot and trajectory. 

The measure of the sensitivity of a sensor configuration is based on the 
procedure proposed in [42] and modified to suit the needs of parallel robots. 
This procedure is based on the calculation of the sensitivity function ^ that 
calculates the deviation of the TCP Sx for the Extended CTC approach along a 
nominal trajectory P^ when the parameter 0^ is uncertain. This is calculated as 
the difference between the deviation of the task coordinates in the nominal case, 
Sx, and the deviation of the task coordinates when the parameter 0 ^ varies from 
its nominal (or ideal) value, 8 x 9 ^, 

% = Sx - 5x 0t (69) 

where the calculation of both Sx and 8 x 9 ^ for a given trajectory and Extended 
CTC configuration requires the linearization of the closed loop dynamics along 
the nominal trajectory P^. 
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Hence, if the dynamics of the robot (Eq. 65) and the Extended CTC control 
law (Eq. 66) are considered, 

Dq c +h — D (q Cd + K v e q + K p e q ) + h (70) 


where D(x,q p ,q c ) is the estimated inertia matrix and h = 
C(x,q p ,q c ,x,q p ,q c )q c + G(x,q p ,q c ) groups the estimated Coriolis and 
gravity terms of the dynamic model implemented in the Extended CTC 
controller. As these matrices are estimated, their calculation will be made in 
terms of uncertain parameters, whose value will vary from the nominal value. 
On the other hand, the inertia matrix D and the nonlinear vector h characterize 
the real dynamics of the robot, whose calculation is done using the nominal 
parameters. 

In order to calculate the linearized dynamics of the closed-loop system, first 
the left term of Eq. 70 will be linearized considering a nominal trajectory Pj, 
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If the linearized model is to be defined in terms of the control coordinates 
q c , the velocity Jacobians detailed in Section 2.2.3 can be used to project the 
model, 


where, 
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where Eq. 72 is defined in terms of the nominal parameters of the model, i.e, 
the real ones. 
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If the same procedure is applied to the right term of Eq. 70, 

Sr = A c 5u + B c 5q c + C c 5q c (73) 

where Su = —K v Sq c — K p 8q c [42]. Note that Eq. 73 is defined in terms of the 
uncertain parameters of the model. 

Combining the linearized Eqs. 71 and 73, the linearized closed loop dynam¬ 
ics can be calculated as, 


0 = A5q c +B5q c +C5q c (74) 

where A. — , B — Bm B^* A.^* ICy and C — Cm A.^ Kp. 

In order to calculate the deviation of the nominal TCP Sx pose required to 
analyze sensitivity, the kinematic relations of Section 2.2.3 can be used, 

5q c = Jp f 8x = J q< , 8x (75) 

Hence, Eq. 74 can be rewritten as, 

5x = (-AJqe)- 1 [(2Aj qc + BJ qc )5x 
+ (AJ qc +Bjq C + CJqc)5x] 

that defines an ODE system, that can be solved for an initial Sxo and an arbitrary 
nominal reference trajectory P c i(t). If the nominal parameters are used, Eq. 76 
will be used to calculate Sx, while if a parameter 0^ is modified, i.e. is uncer¬ 
tain ., the modified parameter will be used to calculate A c , B c and C c , and this 
expression will be used to calculate Sxe r Then, applying Eq. 69, the sensitivity 
function over the reference trajectory will be obtained. 

Note that the absolute value of the sensitivity function ^ will depend on 
the selection of the initial Sxo used to integrate it. Thus, the analysis of the 
normalized sensitivity function is proposed ^ /Sxo. This way, the characteristic 
sensitivity value will be considered as the maximum of the absolute value of the 
normalized sensitivity function. 

4.2. Sensitivity Based Extended CTC Sensor Configuration 
Selection 

In order to validate the sensitivity based Extended CTC sensor configuration 
selection methodology, the Gough-Stewart platform analyzed in Section 2.2 will 
be used as a study case. 
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In Table 3, the ten different sensor configurations to be evaluated are shown, 
being Config. 1 the traditional CTC approach with no extra sensors, and Config. 
10 the one in which all joints are sensorized. In order to compare the sensitivity 
results of these configurations, the controller matrices K p and K v have been 
tuned to obtain an overshoot of 5% and a peak time of 0.1 s for all configurations. 
The nominal values of the robot are those detailed in Table 1, considering a 
maximum identification error of 1mm for lengths, lOg for masses and a 10% 
variation of the inertia nominal value. 

Table 3. Extended CTC configurations to be evaluated 


Config 1 

q c = q a 

Config 2 

qc=[qa r 9 t ] T 

Config 3 

q c = [ q/ V T } T 

Config 4 

qc = [ q/ [0]f,3,6 Mf.3,6 ] ^ 

Config 5 

q c =[q a r 0 i 03 (pi 93 } T 

Config 6 

q c = [q a r 0 i 03 (pi ] T 

Config 7 

q c = [q/ 0 i 03 93 \ 

Config 8 

q c =[q a r 0 i 03 06 \ 

Config 9 

q c = [ q/ 91 93 96 ] 

Config 10 

q c = q 


As the proposed methodology requires a nominal trajectory to be evaluated, 
the helicoidal trajectory detailed in Eq. 67 (Fig. 9) will be used. 

The sensitivity related to orientation and position coordinates will be evalu¬ 
ated separately. For that purpose, the following expressions will be used, 

= v / «.> 2+ «,) 2 +®,) 2 
er = v'«/ + <> 2+ <4> 2 

This way, the characteristic sensitivity value of each Extended CTC config¬ 
uration will be calculated as the sum of the absolute maximum sensitivity values 
of all model parameters when an initial TCP pose deviation of Sxo = 0.001 m is 
considered. 
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Results are shown in Figs. 14 and 15. As it can be seen, the sensitivity 
of the Extended CTC approach varies depending on the sensor distribution, as 
seen previously. However, it can be seen that the dynamic performance and ro¬ 
bustness of the use of redundant data is higher than the classical CTC approach 
(Config. 1). 

The appropriate selection of the Extended CTC sensor configuration can 
be carried out applying different criteria. This way, if economic criteria are 
considered, a less number of sensors will reduce the cost of the robot. In these 
cases, Config. 3 and Config 4. seem to be the best alternatives considering 
the number of sensors vs performance criteria. However, if the robustness is 
to be maximized, the full sensorization of the robot (Config. 10) is the best 
alternative. 

As it can be seen, it is shown that the characteristic sensitivity value calcu¬ 
lated for the Extended CTC approach varies depending on the selected sensor 
configuration, illustrating the need of a preliminary analysis to select the most 
suitable sensor configuration for a given robot and task. 



Figure 14. Normalized position Sensitivity £ max 




Conclusion 

Control is a central issue in parallel robos, as these mechanisms are usually 
used in high performance tasks where heavy load handling, precision and/or 
speed are required. However, being a recently rediscovered field, there are still 
many areas in parallel robotics that need further research. 
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Figure 15. Normalized orientation Sensitivity £ max 
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In this paper, the use of extra sensors in passive joints of parallel robots 
is proposed for position control purposes. The extra data provided by these 
sensors can reduce the computational cost of the kinematic and dynamic model, 
increase the robustness of the controller and provide better dynamic behaviour. 

These advantages are demonstrated in the Extended CTC approach, a con¬ 
trol scheme that combines the advantages of redundant sensors and advanced, 
model-based controllers. In this paper, the three steps for implementing this 
approach are analyzed briefly: the calculation of a generic, redundant, recon- 
figurable dynamic model, the definition of the control law, and its implementa¬ 
tion. Moreover, a procedure to select the most suitable configurations is detailed 
based on a sensitivity approach. A study case based on the Gough-Stewart plat¬ 
form is proposed. 

The procedures and control laws defined in this paper can be used in those 
applications where high performance criteria need to be met, such as medi¬ 
cal applications or medium load pick-and-place tasks. Based on these ideas, 
new control approaches can be derived, modifying the formulation to consider 
sensors that measure other magnitudes such as acceleration or force. Further 
research is being carried on focusing in industrial applications such as test rigs 
for vehicle suspension based on parallel robots. 
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Abstract 

Strong kinematic coupling is one of inherent properties for general parallel 
robotic manipulators. Although it contributes high stiffness and large loading 
capability, it also leads to complicated kinematic solutions, difficult controlling 
design and path planning, which will take passive effects for the actual 
applications of the parallel manipulators. A new systematic method for structure 
synthesis of four-degree-of-freedom fully-isotropic parallel robotic manipulators 
is proposed in this paper. The moving platform of the mechanism consists of 
two-rotational and two-translational (2R2T) motion components with respect to 
the fixed base. Firstly, structure synthesis of uncoupled 2R2T parallel robotic 
manipulator is set up based on the concept of hybrid mechanism and the 
reciprocal screw theory for the first time. Then, type synthesis of fully-isotropic 
2R2T parallel robotic manipulator is performed by changing one kinematical 
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chain’s structure of the uncoupled parallel robotic manipulator obtained before. 
A lot of novel uncoupled and fully-isotropic 2R2T parallel robotic manipulators 
are synthesized. Kinematical Jacobian of a fully-isotropic 2R2T parallel robot is 
a 4x4 identity matrix, so there is a one-to-one linear mapping correspondence 
between the output velocity of the platform and the input velocity of the actuated 
joints. Therefore, one independent output of the moving platform can be 
controlled only by one actuator. 


1. Introduction 

A parallel robotic manipulator is a typically closed-loop mechanism which is 
composed of a moving platform connected to a fixed base by several serial open- 
single kinematical chains (or called limbs) in parallel [1-3]. In order to achieve 
certain special properties, the serial open-single kinematic chain was replaced by a 
hybrid chain [4, 5], in which there is at least one leg composed of a closed loop 
structure. Compared with traditional serial mechanisms, parallel manipulators 
have many merits, such as high stiffness, large load carrying capacity, high 
accuracy and high velocity. Therefore, parallel robotic manipulators have 
potential applications in the fields of industrial robots, flight simulators, parallel 
machine tools, medical devices, radar antennas and telescopes. Delta Robot [6] is 
one of the most famous parallel manipulators and applied successfully in the 
industrial fields. However, parallel manipulators also have some drawbacks, such 
as, small workspace, high coupling of kinematics and dynamics, difficult control 
design and path planning. 

Four-degrees of freedom parallel robotic manipulators can be divided into 
three types based on the different motion output characteristics of the moving 
platform, i.e., one-rotational and three-translational type (1R3T), three-rotational 
and one-translational type (3R1T), two-rotational and two-translational type 
(2R2T). The former two types have been well studied and many novel 
manipulators were designed [7-9]. As for 2R2T parallel manipulators, only a few 
of them were reported in literatures. Lu [10] presented a 2R2T parallel 
manipulator with three legs, in which one of the legs provides two actuators to 
drive the platform. Abbasnejad [11] designed a 2R2T parallel manipulator with 
five limbs, in which one limb only restricts the output motion properties of the 
platform, but it does not control them. 

Strong kinematic coupling is one of inherent properties for general parallel 
robotic manipulators. Although it contributes high stiffness and large loading 
capability, it also leads to complicated kinematic solutions, difficult controlling 
design and path planning, which will take passive effects for the actual 
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applications of the parallel manipulators. Recently, many scholars have paid more 
and more attentions on decoupled parallel robotic manipulators [12-17], which 
have simple linear kinematic solutions. The most remarkable characteristic for the 
decoupled parallel robotic manipulators is that their Jacobian is a triangular 
matrix. The mechanism is called uncoupled parallel robotic manipulator when its 
Jacobian is a diagonal matrix [18]. In this case, there exists a one-to-one 
relationship between the outputs of the moving platform and the inputs of 
actuators. If the Jacobian of a parallel manipulator is an identical matrix, it is 
defined as a fully-isotropic parallel robotic manipulator, because the condition 
number is constantly equal to 1 throughout the entire workspace. So this kind of 
manipulator has well performance in kinematic and dynamic transmission 
capabilities. Kong and Gosselin [19] addressed type synthesis of linear 
translational parallel manipulators based on the geometrical approach, among 
which some are uncoupled parallel manipulators and others are fully-isotropic 
parallel manipulators. Kuo and Dai [20] designed a fully-isotropic parallel 
orientation manipulator composed of three active legs and one passive spherical 
joint. Carricato [21] put forward type synthesis of fully-isotropic 3T1R parallel 
manipulators in terms of the screw theory. Planar 2T1R fully-isotropic parallel 
manipulators were investigated based on the screw theory and many novel 
manipulators were obtained in [22]. Gogu [23, 24] has completed type synthesis 
of fully-isotropic parallel manipulators based on linear transformation theory. 
Notably, structure synthesis of fully-isotropic 2R2T parallel manipulators has 
been performed as well [25].However, each manipulator consists of one complex 
leg. This complicated structure probably leads to some problems in order to obtain 
the expected motion property and precision. 

A new systematic method for type synthesis of the fully-isotropic 2R2T 
parallel manipulators is presented based on the concept of hybrid manipulator and 
the reciprocal screw theory in this paper. Other contents are arranged as 
following: structure design of a fully-isotropic 2R2T hybrid manipulator is 
discussed in section 2, there exists a one-to-one corresponding relationship 
between the output velocity of the moving platform and the input velocity of the 
actuated joints for these mechanisms. So each output motion of the platform is 
only controlled by one actuator. 
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2. Structure Design and Kinematic Analysis of a 
Fully-Isotropic 2R2T Hybrid Mechanism 

A hybrid mechanism is defined as a mechanism which is composed of a parallel 
manipulator connected with a single open kinematic chain or two parallel 
manipulators assembled serially. In this paper, suppose each fully-isotropic 2R2T 
hybrid mechanism includes one parallel component and one serial component. The 
parallel part is a fully-isotropic 2T1R planar parallel manipulator selected from [22] 
and the serial part is a single open kinematic chain which only consists of one 
revolute joint. A new fully-isotropic 2R2T hybrid mechanism is shown in Figure 1. 
The parallel component of the hybrid mechanism is made of three legs. The first leg 
is composed of two prismatic pairs and one revolute joint. Their axes are 
perpendicular to each other. Thus, the structure of the first leg can be defined as 
P x _L P 2 _L R 3 from the base to the platform in sequence. The second consists of two 
prismatic pairs and three revolute joints. The axes of the first prismatic pair and the 
first two re volute joints are parallel to each other and perpendicular to the second 
prismatic pair, and the axis of the last re volute joint is perpendicular to the first 
prismatic pair, but neither parallel to nor perpendicular to the second pair, i.e., 
P 4 / /R 5 (_L P 6 _L) / /R 7 _L R 8 . The third consists of two revolute and two universal 
joints. The axes of two re volute joints are orthogonal. Adjacent rotary axes of two 
universal joints are parallel and the other axes of them are parallel to the axis of 
second re volute joint. The sequence of these joints from the base to the output link 
OL isR 9 _LR 10 -U n -U 12 . Here, P, R, C and U denote the prismatic, re volute, 
cylindrical and universal (or Hooke) joints, respectively. The assembly conditions 
of three legs are as follows: the axes of joints P x , P 4 and R 9 mounted on the base 
are normal to each other and these joints are selected as the actuated joints. 
Meanwhile, their axes are parallel to the x, y and z axes of the fixed frame O - xyz , 
respectively. Axes of joints R 3 and R 8 are collinear and perpendicular to the 
adjacent axis within U 12 joint. Joints R 3 , R 8 and U 12 are all connected with the 
output link OL. When three actuated joints are driven, the output link will translate 
along x-, y-axes and rotate around z-axis, i.e., the parallel part is a 3-DOF planar 
manipulator. Jacobian of this planar parallel manipulator is a 3x3 identity matrix 
[20]. In other words, this mechanism shows fully-isotropic throughout the entire 
workspace because the condition number of its Jacobian is identically equal to 1. 
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Figure 1. Fully-isotropic 2R2T hybrid manipulator. 

In order to develop a hybrid 2R2T mechanism, a revolute joint, R 13 , is 
connected to the output link OL of the planar parallel manipulator in serial. The 
assembly condition is that the axis of joint R 13 is perpendicular to the axis of joint 
R 8 (or R 3 ). In the initial installing position, the axis of R 13 is parallel to y-axis. 
In addition, joint R 13 is also an actuated joint and driven by an actuator. Then a 
2R2T hybrid mechanism is obtained, shown in Figure 1. Its moving platform 
( MP ) with four degrees of freedom is connected to joint R 13 . 

Another coordinate frame (or called moving frame), P-uvw, is attached on 
the platform. Origin point P is located on the intersection between the axes of 
joints R 13 and R 8 , v-axis is aligned with the axis of joint R 13 ,w-axis is 
perpendicular to the plane of the moving platform, u -axis obeys the right-hand 
rule. 

Based on the architecture and assembly conditions of the mechanism, the 
velocity equation of point P with respect to the fixed frame O - xyz can be 
derived as follows 
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Where v x and v y are the linear velocities along x- and y- axes, respectively. 
co v and a> z are the angular velocities around v- and z-axes, respectively. q x , q 2 , q 3 
and q A are the generalized input velocities of four actuated joints. Obviously, the 
Jacobian is a 4x4 identity matrix, so this hybrid mechanism shows fully-isotropic 
too. There exists a linear mapping relationship between the input velocity space 
and the output velocity space. 


3. Position Analysis 

Referring to Figure 1, let point M is arbitrary on the moving platform and 
M p = (r,0,0) T is its coordinate with respect to the frame P-uvw . The coordinate 
of the origin point P within the fixed frame is P Q = (x,y,z) T = {q v q 2 ,a ) T , where q x 
and q 2 are the input displacements of the actuated joints P x and P 4 , respectively, 
a is the structure size denoting the distance from origin P to the fixed plane 
determined by x- and y-axes. The coordinate of point M with respect to the fixed 
frame can be calculated as follows 

M 0 = RM P +P Q (2) 

where M 0 = (. x M , y M , z M ) T , R is the rotational matrix from the moving frame to 
the fixed one. 

Assume 6 and p are the posture angles of the moving platform. Since the 
hybrid mechanism is uncoupled, both posture angle 6 and p are only relate to 
the actuated inputs q A of joint R 13 and q 3 of joint R 9 , respectively. Thus, the 
rotational matrix R can be derived 
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Substituting Equation (3) into (2), yields 




r cos 6 cos p + q n 

y m 

= 

r cos# sin p + q n 

_ Z M _ 


r sin 6 + a 


Based on Equation (4), one can see that x M relates to the actuated input q x of 
the first leg and two pose angles 6 and p of the platform. Similarly, y M is the 
function of the variables of q 2 , 6 and p . However, z M only depends on the 
variable of 6 , which means that if the position coordinate z M is given, pose angle 
6 will be measured inversely. In other words, if there is another leg which is used 
to control coordinate z M of point M independently, one uncoupled parallel 
manipulator will be obtained. 


4. Structure Synthesis of the Fourth Leg 

In order to design the uncoupled 2R2T parallel robotic manipulators, the fourth 
leg should be designed to provide single driving force for the platform along 
z-axis. Without loss of generality, suppose there are only two kinds of single-DOF 
joint in the fourth leg, i.e., prismatic and revolute joints. Structure synthesis of 
fully-isotropic translational parallel manipulators was addressed by use of the 
reciprocal screw theory in [26]. Research results show that the actuation screw, 
which provides the direct actuated force along one moving direction for the 
platform, of each leg for the fully-isotropic translational parallel manipulator, 
must be a pure force screw. At the same time, the actuated screw of the same leg 
should be an infinite-pitch screw and its axis is parallel to the moving direction. 

Since the fourth leg is used to control the moving displacement of the 
platform along z-axis, the actuation screw $ a4 should be a zero-pitch screw 
parallel to z-axis and the actuated screw $ 4 is an infinite-pitch screw parallel to z- 
axis [24], respectively. Therefore, 

£ fl 4=[0,0,l ;j P fl4 ,a, 4 ,0] T (5) 


$ 4 = [0,0,0;0,0,1] T 


(6) 
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where P a4 and Q a4 are the position parameters of $ a4 . 

Equation (6) suggests that the actuated joint of the fourth leg is a prismatic 
pair and its moving direction is along z-axis. 

In terms of the reciprocal law, the actuation screw is reciprocal to all 
kinematic screws of other joints with the exception of the actuated screw within 
the identical leg. Therefore, all the possible active non-actuated screws of the 
fourth leg can be listed below: 

1. Zero-pitch screws parallel to z-axis. They cannot be directly connected to 
the moving platform or through the infinite-pitch screw. There must be at 
least one zero-pitch screw and at most three in the fourth leg. 

2. Infinite-pitch screws perpendicular to z-axis. They can be placed at any 
position in the leg. There at most two infinite-pitch screws and their axes 
should not be parallel to each other. 

3. Zero-pitch screw. It intersects the axis of the actuation screw $ a4 and is 
parallel to the axis of joint R 13 . There exists one and only one zero-pitch 
screw in the fourth leg. 

In addition, the zero-pitch screw, which intersects the axis of the actuation 
screw $ a4 and is perpendicular to the axes of the screws defined in steps (1) and 
(3), is called idle screw. This kind of screw can be inserted at any place and its 
number does not exceed one. 

For the uncoupled 2R2T parallel manipulator, it is obvious that the platform 
has two rotational degrees of freedom. At the same time, three coordinates of 
point M are variable during the moving process, as shown in Equation (4). 
Therefore, the terminal link of the fourth leg should have at least three- 
translational and two-rotational degrees of freedom with respect to the initial link 
(or fixed base). If the connectivity of the fourth leg is equal to six, there must be 
one idle re volute joint. Otherwise, a redundant DOF exists. 

According to the types and assembly conditions of the actuated joint and non- 
actuated screws, all potential kinematic chains of the fourth leg can be enumerated 
based on different connectivity (see Table 1). The first joint in each leg is selected 
as the actuator. As far as C joint connected to the base is concerned, its linear 
DOF will be chosen as the actuated input. Fet subscripts, i, j and k, denote the 
translational or rotational directions of the corresponding joints and the unit vector 
space formed by three directions is linear independent. As for the P-pair following 
the subscript n , their moving directions must be perpendicular to w-axis. Fet X 
represent a joint with an idle rotational DOF in the leg, where its connectivity is 
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equal to 6. In order to simplify the structure of the kinematic chains, the axes of 
the adjacent joints are regarded as parallel or perpendicular to each other. Such as 
the kinematic chain QRjU^Rj, the first joint is a cylindrical pair parallel to i-axis 

and its linear DOF is chosen as the actuated input, the second is a re volute joint 
parallel to i-axis too, the third is a Hooke joint with one axis parallel to the i-axis 
and another axis parallel to the k-axis, the rotational DOF about the k-axis is idle, 
and the last is a revolute joint parallel to the j-axis, which implies the last joint 
axis is normal to all others axes in the chain. 


Table 1. Kinematic chains of the fourth leg 


F c 

Type 

Order 

Basic chains 

Chains with complex 
joints 

5 

1P4R 

1-4 

PiRiRiRiRj 

PiRiRiUijj CiRiRiRj 

CiRiUij 

2P3R 

5-16 

PiPnRiRiRj; PiRiPnRiRj 

PiRiRiPnRj; PiRiRiRjPj 

PiPnRiUij; PiRiPnUij 

PiRiRiQ; CiPnRiRj 

CiRiPnRj; CiRiRjPj 

CiPnUij; CiRiCj 

3P2R 

17-22 

PiPjPkRiRj; PiRiPkPjRj 

PiPjPkUij; CiPkPjRj 

PiRiPkQ; CiPkCj 

6 

1P5R 

23-47 

PiRkRiRiRiRj; PiRiRkRiRiRj 

PiRiRiRkRiRj;PiRiRiRiRkRjPiRiRiRiRjRk 

PiUkiRiRiRj; PiRiUkiRiRj 

PiRiRkRiUij; PiRkRiRiUij 

PiRiRiUkiRj; PiRiRiRkUij 

PiRiRiRiUkj; PiRiUkiUij 

PiUkiRiUij; CiRkRiRiRj 

CiRiRkRiRj; CiRkRiUy 

CiRiRiRkRj; CiUkiRiRj 

CiRiRkUij; CiRiUkiRj 

CiRiRiUkj; CiUkiUij 

PiRiRiS; CiRiS 

2P4R 

48-77 

PiPnRkRiRiRj; PiPnRiRkRiRj 

PiPnRiRiRkRj; PiPnRiRiRjRk 

PiRkRiPnRiRj; PiRiRkPnRiRj 

P iRiP nRkRiRjP iRiPnRiRkRj 

P iRiP nRiRj Rk j P iRkRiRiP nRj 

P iRiRkRiP nRj! P iRiRiRkP nRj 

P iRiRiP nRkRj 5 P iRiRiP nRj Rk 

PiPnRkRiUij; PiCkRiRiRj 

PiPnRiRkUij; PiPnRiUkiRj 

PiUkiPnRiRj; PiRkRiPnUij 

PiRiCkRiRj; PiRiRwPnUij 

PiRwRiRiQ; PiUkiRiPnRj 

PiRiUkiPnRj; PiRiRkRiQ 

PiRiRiPnUjk; PiRiRiCkRj 

CiPnRkRiRj^ CiRkRiPnRj 
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If i-axis is parallel to z-axis of the fixed frame and j-axis is parallel to O-xy 
plane, each kinematic chain in the Table 1 can be regarded as the fourth leg of a 
2R2T parallel manipulator. It only provides the direct driving force for the 
platform along z-axis. 


5. Structure Synthesis of Uncoupled 2R2T Parallel 
Robotic Manipulators 

Uncoupled parallel robotic manipulator is a mechanism, in which a one-to-one 
corresponding control relationship exists between the output motion components 
of the platform and the inputs of the actuated joints. Each actuator of the 
mechanism controls one independent output motion component of the platform. 
An uncoupled parallel manipulator has the distinct characteristics that its velocity 
Jacobian is a diagonal matrix. Structure synthesis of uncoupled 2R2T parallel 
manipulators can be realized by use of one uncoupled 2R2T hybrid mechanism 
designed in Section 2 and one kinematic chain listed in Table 1. For example, one 
may choose the mechanism shown in Figure 1 and aF>R.R.R.R 7 chain in Table 1 

to generate a new 2R2T parallel robotic manipulator named UPM2R2T-I (see 
Figure 2). 

Some assembly conditions should be satisfied in order to achieve the 
uncoupled parallel robotic manipulator. Firstly, the axis of the actuated joint P 14 
located at the base is parallel to z-axis. Secondly, the axes of joints R 13 and R 18 
attached on the platform are parallel to each other. In addition, the actuator used to 
drive the joint R 13 in Figure 1 is removed, which means that the revolute R 13 
becomes a passive joint. The fourth leg controls the rotational DOF about thev- 
axis of the platform in Figure 2. 

Referring to Figure 2, q A is the linear input displacement of the actuated joint 
P 14 .r is the length of the platform’s structural size. The velocity equation of point 
P on the platform within the fixed frame is 
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Figure 3. Uncoupled 2R2T parallel robotic manipulator UPM2R2T-II. 
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The Jacobian in Equation (7) is a diagonal matrix, so this manipulator is an 
uncoupled 2R2T parallel robotic manipulator. An one-to-one mapping 
relationship exists between the output velocity vector space of the platform and 
the inputs velocity vector space of the actuated joints, i.e., v x = q { , v y =q 2 , co z = q 3 

and co y - bq A . 

Similarly, other kinematic chains in Table 1 may be selected to replace the 
fourth leg of the manipulators in Figures 2 and 3.Thus, many uncoupled 2R2T 
parallel manipulators can be synthesized and two novel manipulators are listed in 
Figure 4. 

Even though the axes of joints R 3 and R 8 are collinear, there is no any 
relative motion between them. Therefore, these joints can be replaced by one 
re volute joint. Then another new uncoupled 2R2T parallel robotic manipulator 
named UPM2R2T-II is obtained, shown in Figure 3. Its output characteristics and 
kinematic performances are similar to the original. 



a 


Figure 4. (Continued) 
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b 

Figure 4. Other two novel 2R2T uncoupled parallel robotic manipulators. 



Figure 5. Fully-isotropic 2R2T parallel robotic manipulator. 
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6. Structure Synthesis of Fully-Isotropic T2R2 Parallel 
Robotic Manipulators 

Replacing the prismatic pair of the fourth leg in UPM2R2T-I with a simple 
kinematic chain containing two revolute joints (R14 and R19) with parallel axes 
will yield a new 2R2T parallel robotic manipulator, in which the axis of joint R 14 
(or R 19 ) is perpendicular to the axis of joint R 15 and not parallel to joint R 18 . In 
order to realize the expected target, there are some structural conditions to be 
satisfied. On the one hand, the plane defined by the axes of R 13 and R 19 is 
parallel to the O-xy plane. On the other hand, link size between joints R 19 and 
R 14 is equal to the length of platform (see Figure 5). If joint R 19 is selected as the 
actuated joint of the fourth leg and q A is the actuated input angle, then velocity 
equation of the verified manipulator in Figure 5 is as follows: 
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It is very interesting that the Jacobian in Equation (8) is a 4x4 identical matrix 
and its condition number is constantly equal to 1 throughout the whole workspace 
of the manipulator. This property reveals that the manipulator shows fully- 
isotropic in kinematics. So the mechanism is a fully-isotropic parallel robotic 
manipulator. Meanwhile, there is no singular configuration for the manipulator in 
the workspace since the special Jacobin. 

According to above method, if the prismatic pair of the fourth leg in 
UPM2R2T-I is replaced by a parallelogram with four re volute joints and the side 
link length is equal to the platform size r, a new fully-isotropic 2R2T parallel 
manipulator is obtained (see Figure 6). 

Similarly, for all uncoupled 2R2T parallel manipulators synthesized in 
Section 5, if the linear actuated joint in the fourth leg is replaced by a kinematic 
chain with two re volute joints or a parallelogram structure with four re volute 
joints, they can be evolved into fully-isotropic 2R2T parallel manipulators as well. 
It is true that the special structure size is necessary in order to obtain the expected 
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Figure 6. Another fully-isotropic 2R2T parallel robotic manipulator. 



Figure 7. Novel fully-isotropic 2R2T parallel robotic manipulator with a parallelogram 
structure. 
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mechanisms. Furthermore, if the connectivity of the fourth leg is 6, its linear input 
joint can only be replaced by a parallelogram structure. Otherwise, the leg will 
include one redundant joint. For example, as far as the mechanism in Figure 5(b) 
is concerned, if the linear input DOF of the fourth leg is replaced by a 
parallelogram, a new fully-isotropic 2R2T parallel robotic manipulator can be 
developed (shown in Figure 7). 


Conclusion 

This paper presents a novel and systematic method for type synthesis of fully- 
isotropic 2R2T parallel robotic manipulators. The uncoupled 2R2T parallel 
robotic manipulators are synthesized based on the concept of hybrid mechanisms 
and the reciprocal screw theory. The fully-isotropic 2R2T parallel robotic 
manipulators are developed by using a kinematic chain with two re volute joints or 
a parallelogram structure to replace the linear input actuated joint in the fourth leg 
of each uncoupled 2R2T parallel mechanisms. For all of the proposed parallel 
mechanisms, their Jacobian that maps the input velocity vector space to the output 
velocity vector space of the platform is a 4x4 identity matrix. This leads to a one- 
to-one correspondence between the output motion components of the platform and 
the inputs of the actuators. Both the condition number and the determinant of the 
Jacobian matrix are equal to one. Therefore, there is no any singular configuration 
throughout the entire workspace and these mechanisms possess good performance 
characteristics in force and motion transmission. Control design and path planning 
of these mechanisms become very simple. All the uncoupled and the fully- 
isotropic 2R2T parallel manipulators proposed in this paper are original. 
Moreover, each parallel manipulator only consists of the prismatic, revolute, 
cylindrical, universal, or spherical joints, without the homokinetic joints or 
redundancy actuation. All these features will reduce the cost of manufacture and 
assembly. 
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The Parallel Two-Legged Walking 
Robot CENTAUROB 
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Abstract 

In this chapter, we review the new prototype of the two-legged, paral¬ 
lel kinematic walking robot CENTAUROB, developed at Hamburg Uni¬ 
versity of Technology. The main features of this robot are its modular, 
symmetric structure, the construction of the legs as Stewart platforms 
(hexapods), and the special C-shaped feet that allow a statically stable 
movement at any time. The symmetric structure of the robot leads to a 
center of gravity exactly in the middle of the hip and prevents from a pre¬ 
ferred moving direction or an asymmetric load of the legs. As a highly 
flexible walking device, the CENTAUROB is able to walk in unpaved en¬ 
vironment, avoid and overcome obstacles, and even handle straight and 
circular stairs. 

Keywords: parallel robots, service robots, biped walking, statically stable walk¬ 
ing, sensor architecture, control concepts, walking scenarios 
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1. Introduction 

Industrial robots are well established in production processes. Since recent 
years, there has also been a growing demand for service robots both for private 
use, for example, as a ride-on device for the mobility assurance of immobile 
people or as an interactive care giving robot in the household, and for use in 
industrial environments, for example, as a simple industrial carrying device or 
as an autonomous robot in rough or dangerous areas like mine fields or burn¬ 
ing houses. Market studies show that the demand in robotic systems will rise 
steadily in the coming years. Due to higher performance-requirements with 
respect to dynamics, precision, velocity, weight, control intelligence, suitabil¬ 
ity for automation, price, etc., most of the conventional robot solutions have 
reached their limits. 

Biped robots can be classified by their kinematic structure into serial and 
parallel ones. Serial kinematic robots are most often used due to the lower con¬ 
trol effort. Well known examples for humanoid robots with a serial kinematic 
are Honda’s humanoid robot Asimo [1], the humanoid robot LOLA [2], and the 
WABIAN series [3]. Parallel robots offer special advantages including higher 
stiffnesses, smaller overall machine sizes, lower inertial forces, faster processing 
velocities, and compensatory dimensional errors. The operating load occurring 
at the end effector is divided among several links which results in a high stiffness 
of the structure. The two-legged, parallel kinematic walking robot CENTAU- 
ROB, developed in 1997 [4], was by then the first biped robot using two Stewart 
platforms as leg structures. It was the first parallel walking robot that was able to 
walk statically stable even in unpaved environments, avoid and overcome obsta¬ 
cles, and even handle straight and circular stairs. A second realization of a biped 
robot with a parallel kinematic, which exists up to now, is the Waseda-Leg [3]. 

In this chapter, we review the new prototype of the CENTAUROB [5], de¬ 
veloped at Hamburg University of Technology. Just like the first prototype [6], 
the redeveloped construction is based on the Stewart platform as well. Several 
modifications were made due to the moving technique standard and to solve 
disadvantages and problems [7]. 

The new prototype represents a universal moving device which convinces 
by its high stability and payload and offers plenty of application possibilities. 
In future, the robot will be able to operate autonomously and automatically 
recognize obstacles and overcome them. Possible fields of usage that come into 
mind are, for example, as a ride-on device for immobile people, as a service or 
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interactive care giving robot in the household, as a simple industrial carrying 
device in unpaved terrain, or as an autonomous robot in rough or dangerous 
areas like mine fields or burning houses. 

The remainder of this chapter is organized as follows. In Section 2, we dis¬ 
cuss parallel robots and their applicability as biped walking robots. In Sections 
3 and 4, we review the first prototype, the redesign process, and the new proto¬ 
type of the CENTAUROB. In Section 5, we briefly present the inverse kinematic 
model of the robot followed by the motion control strategy in Section 6. Section 
7 presents several walking scenarios and other motions to show the agility of the 
robot. In Section 8, possible applications and fields of usage for the robot are 
discussed. Finally, in Section 9, this chapter is summarized and an outlook to 
future work is given. 

2. Parallel Walking Robots 

2.1. Parallel Robots 

Currently, the field of industrial robots is dominated by articulated robots where 
the driven axes are arranged in series, so-called serial robots. A well known 
example is the SCARA robot, short for ’Selective Compliance Assembly Robot 
Arm’. Serial robots owe their success mainly to the high degree of flexibility, 
the high workspace-to-footprint ratio, as well as the low calculation and control 
effort due to the easily solvable direct kinematics. Although the serial structure 
leads to high flexibility, this is also a main disadvantage since positioning errors 
in the driven joints as well as the elasticity of each component of the structure 
accumulate and lead to lower positioning accuracies and vibration problems. 
In order to compensate these problems with higher driving forces and inertia 
torques, drives that are further away from the end-effectors are scaled larger. 

Parallel robots can overcome these drawbacks. The name results from their 
parallel kinematic structure in which the drives operate side by side. The load 
is distributed over multiple paths, and the drives do not have to hold each other. 
This results in high rigidity, similar to a framework. The positioning accuracy 
is also very high because the positioning errors of the individual drives do not 
accumulate. The moving masses are smaller, so that the machine dynamics can 
be controlled by the use of lower power ratings. As a result of these advantages, 
parallel robots have become more relevant in fields where high process forces 
and special accuracies are required. The main applications for parallel robots 
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are widely ranged and spread from motion simulators and test benches over 
machine tools for handling and manufacturing to brain surgery. However, the 
mobility and flexibility of serial robots cannot be obtained. 

There are many possible configurations of parallel robots which differ, in 
particular, by the type of drive (rotary or linear) and the degrees of freedom. 
One of the most universal parallel robot is the hexapod. The hexapod is also 
called Gough-Stewart platform according to the developers who have used these 
parallel kinematics for the first time [8], [9]. 

The function of a hexapod is to move the end-effector in all translational and 
rotational axes in space. Six parallel drives connect the stationary base platform 
with the mobile tool platform. On top of the tool platform, the end-effector is 
mounted for specific tasks. If, for any particular purpose, it is not necessary to 
reach the full dimension of the workspace, the number of drives can be reduced 
as long as additional joints or supports are introduced. For example, when using 
a rotary tool, such as a milling cutter, no rotatory degree of freedom is necessary. 
A well known example of a parallel manufacturing robot is the three degree of 
freedom delta robot [10], which uses only three drives and an additional passive 
guidance. 

2.2. Service Robots 

Generally, biped robots will take their place in the near future in the area of mo¬ 
bile service robots and will act as a substitute for humans or support them. The 
tasks will range from the operation in hazardous environments up to a general 
support in the household [11]. Especially in Japan, the realization of this vision 
is already well advanced. In the field of service robotics, a dichotomy between 
specialized and universal robots can be observed. Specialized service robots 
already have a high practical relevance and were tested for various distribution 
functions, for example, in hospitals [12], [13], [14]. Here, the drive kinematics 
has minor importance since navigation is only necessary in known barrier-free 
environments. In addition to these robots, for specific tasks, there is the aim to 
construct a universal robot. Generally, a human-like form is used as a model. 

According to the definition of the International Federation of Robotics, a 
service robot is described as follows. ’A service robot is a robot which operates 
semi- or fully autonomously to perform services useful to the well-being of 
humans and equipment, excluding manufacturing operations.’ 

Currently, autonomy is the biggest problem. Further challenges are the 
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power supply and the autonomous navigation. By methods of image recognition 
and processing, robots are independently able to move. The energy consump¬ 
tion of the drives, however, still leads to short periods of use. Optimally, battery 
charging stations are installed that are automatically visited by robots with a 
low energy level. The wider the field of applications get, the larger and heavier 
become the batteries the robot has to carry. Especially for humanoid robots, 
this is a huge problem because they usually carry the batteries as a backpack. 
With increasing weight of the batteries, the center of mass is shifted upwards, 
resulting in a lower tilt stability. 

2.3. Humanoid Robots 

In order to construct a robot, the human locomotive system is often used as a 
model. These robots are called humanoid robots. Such a transfer of biologically 
successful principles into a technical application is called bionics. 

The motion of a biped is one of the major challenges of research because it 
allows optimal locomotion in unstructured environments. Following the guiding 
principle of bionics according to the model of joint and muscle arrangements of 
humans, a robot with a comparable consolidation achieves an approximately 
equal mobility. An essential feature of the construction of the legs are the joints 
at the hips, the feet, and especially the knees. Compared to human joints, they 
are limited in the degrees of freedom, number, size, and resilience. As a result, 
only a simplified transfer to the robot is possible. However, it should be noted 
that bionics is only implicitly mentioned as a motivation for the design of a 
robot with knee joints. Equally important is certainly the vision of maintaining 
or increasing the workforce of a human by a robot, which is optimally solved 
when the robot is built like a human. Moreover, the acceptance of a humanoid 
robot would probably be higher since it would act more as a person and less as 
a machine. 

The biggest problems of bipeds are balance control and coordination of mo¬ 
tions, which have already been treated in many works. Even for well-developed 
models, fast walking is still challenging. This fails mostly due to the high 
computation burden. The best-known representatives of humanoid robots are 
ASIMO [1], the model of the company Honda, and LOLA [2], a very advanced 
model with automatic obstacle detection from the Technical University of Mu¬ 
nich. 

The overall conclusion is that many research groups and institutions are 
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concerned with the research and development of humanoid robots. Aside from 
a few models of large corporations, only a few bipeds have left the prototype 
stage yet. The reason is, probably, the relatively low interest of the industry 
since the way to a fully operational, robust, and secure biped is still far away. 
ASIMO, for example, which has already achieved a worldwide recognition, is 
more used to serve the image of the company than to execute household’s duties. 
However, the theoretical fields of usage and applications for humanoid robots 
are very large, for example, in dangerous environments. Here, bipeds could be 
invaluable, so that their development is of great benefit. 

2.4. Alternative Leg Structures 

Usually, the joints of the robot are actuated directly. The stabilizing effect of 
muscles, which are connected to the bone, is not given. The problem of the 
lower stiffness of serially robots thus transfers to the robot’s knee. This prob¬ 
lem can probably be solved constructively or by reducing the walking speed. 
As a reasonable alternative, parallel kinematics can be used which offer high 
stiffness and stability. However, the flexibility and the large workspace of serial 
kinematics cannot be reached because the stability allows only small walking 
steps. 

3. First Prototype of the CENTAUROB 

The first prototype of the CENTAUROB, shown in Fig. 1, consists of two 
hexapods as leg structures. This feature is a fundamental difference to other 
humanoid robots. It establishes new ways of movement strategies and tasks. 
The aim is to use the robot in specific fields where the advantages of its parallel 
kinematic structure can be fully exploited. These advantages mainly include the 
high payload capacity, the high rigidity, as well as the possible large step size 
and step height. High steps and staircases can be climbed by alternately extend¬ 
ing and retracting the telescopic legs. Moreover, passing low openings is also 
not a problem because both legs can be simultaneously retracted to reduce the 
body height. 

The robot has two specially designed C-shaped feet to ensure a statically 
stable walking at any time. This means that the ground projection of the overall 
center of mass of the robot must always remain in the area spanned by the feet, 
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Figure 1. The world’s first spiral stair climbing robot, own patent. 


the so-called stability region. Figure 2 shows the robot’s stability region with 
one foot and two feet on the ground. 




Figure 2. Stability region of the CENTAUROB with one foot (left) and two feet 
on the ground (right). 


The joints of each leg are arranged in circles with different radii. A reduction 
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of the upper joints’ radius would move the static and kinematic properties of the 
legs to an unfavorable area. The requirements for small space and high stability 
are divergent and cannot be optimally achieved simultaneously. 

The robot is operated by a pure feed-forward or open loop control. Be¬ 
cause for statically stable motion, dynamic influences such as accelerations are 
disregarded, the robot’s movement can only be performed very slowly. 

The CENTAUROB’s advantages and disadvantages compared to other hu¬ 
manoid robots are summarized in Table 1. 


Table 1. Advantages and disadvantages of the CENTAUROB compared to 

other robots 


Advantages 

Disadvantages 

high payload to weight ratio 

limited workspace due to leg colli¬ 
sions 

high feet flexibility 

operating close to singular configu¬ 
rations 

ability to overcome complex obsta¬ 
cles 

large leg cross sections 

statically stable motion 

high calculation effort in control 

accurate and stable alignment 

of the hip while standing 

friction afflicted operation of all ac¬ 
tuators 

for the movement in only one de¬ 
gree of freedom 

retracting and extending of legs 


leg structure modularization 


failure save system 



3.1. Structural Information 

3.1.1. Workspace 

Investigating the kinematics of a robot, the workspace is of great interest. Here, 
a distinction is made between three different workspaces: 


• The maximum workspace indicates the points that can be achieved with 
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at least one orientation of the platform. 

• The total orientation workspace is a subspace of the maximum workspace 
and indicates the points that can be achieved in any orientation of the 
platform. 

• The dexterous workspace indicates the points that can be achieved at a 
given fixed orientation of the platform. 

For hexapods used as machine tools, the calculation of the workspace plays 
an important role. This leads to great interest in capturing tool shifts or inclina¬ 
tions. The large orientation angles mark out the area of operation of a machine 
and prove its competitiveness. In case of the CENTAUROB, however, these 
extreme positions are never approached because the robot might lose its stable 
state. 

For each leg of the CENTAUROB, the calculation of the workspace de¬ 
scribes the positions and orientations the corresponding foot can reach in a sin¬ 
gle step. Investigating only straight planes, the calculation of the dexterous 
workspace is sufficient. Here, it can be assumed that the orientation of the foot 
platforms are always horizontal, respectively, parallel to the floor. Climbing 
stairs is also covered in this case. In addition, studies can be carried out with 
inclined feet. However, this scenario hardly shows significant changes in most 
of the parameters. It is related to the elongated shape of the hexapod, where 
the orientation of the foot platform has low impact on the length and inclina¬ 
tion of the individual drives. The dexterous workspace of the CENTAUROB is 
illustrated in Fig. 3. 

With the help of the calculated workspace, two parameters can be derived. 
These are the step height and the step size of the leg. Particularly, for deter¬ 
mining the maximum surmountable obstacle height, the step height is impor¬ 
tant. This applies even more to the CENTAUROB as its telescopic leg kine¬ 
matics leads to a special mobility. The step height is derived from the vertical 
workspace limits for x — 0 and y — 0. This corresponds with the maximum 
retracted and extended leg in a horizontal state. Is the vertical position known, 
the possible step size can be determined from the boundary of the workspace. 

3.1.2. Singularities 

The workspace specifies only the constructive constraints. Whether the drives 
can reach a specific point or not, is not described by the workspace. Singularities 





Figure 3. Dexterous workspace of one leg of the CENTAUROB. 


can occur at points inside the workspace and cause severe problems. Mathemat¬ 
ically, a singularity is a point at which a model is not defined or actually does not 
work. In a singular configuration, the system’s behavior is not predictable and 
the corresponding motions and forces become uncontrollable. Singularities and 
even configurations close to the singularities should be avoided due to the se¬ 
vere effect on the input-output transmission and possible failures or permanent 
damages. 

The case of losing a degree of freedom occurs, for example, when the drives 
shall act in a perpendicular direction to the drives. In this direction, no forces 
can be applied, with the result that a virtual displacement is possible. This is 
a critical situation for a hexapod. In particular, the extended structure of the 
CENTAUROB nearly leads to parallelly arranged actuators that can take forces 
only slightly in horizontal direction. 

Degrees of freedom can be obtained when a movement of the structure is 
possible for fixed positions of the end-effector. This typically occurs in serial 
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robots when joint axes of drives coincide in the structure. Then, for example, the 
total rotation angle is known while the single rotation angles cannot be uniquely 
determined. The occurrence of singularities can be observed in the kinematic 
model when the JACOBI matrix loses rank. 

3.1.3. Stability 

Stability, especially tilt stability, has high priority for legged robots. It is an 
important part in mainly all phases of the robot’s movement and can be di¬ 
rectly influenced by the structural design, especially of the feet, and the walking 
pattern. Interferences, such as uncertainties in the environment or calculation 
errors, shall not unbalance the robot. Both are grouped under the term stability. 

If a foot is placed on the ground, a contact situation occurs. In this con¬ 
tact situation, tangential and normal forces as well as moments act on the foot. 
They result from internal and external forces on the robot’s body. For the foot, 
there exists a point in which the moments in the plane of contact accumulate 
to zero. This zero-moment point is consistent with the point where the result¬ 
ing compressive force acts on the foot. The stability of the robot is ensured if 
the zero-moment point lies within the stability region, which is formed by the 
convex hull of all points of the contact surface. 

For the CENTAUROB, a statically stable walking pattern is embedded. This 
means that dynamic influences are neglected and only slow, quasi-static move¬ 
ments are possible. Therewith, only the weight of the robot influences the 
robot’s stability. Static stability is thus given if the ground projection of the 
robot’s center of mass lies within the area formed by the feet in contact with the 
ground, see Fig. 2. 

3.1.4. Agility 

The locomotion of the CENTAUROB mainly depends on the relative movement 
between the hip and the foot platform. The transmission of movements from the 
drives to the platforms is given by the kinematics, see Section 5. Therewith, the 
maximum platform velocities can be determined from the maximum velocity of 
a single drive. 

For serial robots, the maximum velocities can usually be determined directly 
from the performance of the drives, as these are each associated with one degree 
of freedom alone. The velocities of an industrial robot cannot be achieved with 
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the CENTAUROB. However, these velocities are not necessary, as long as a 
statically stable movement is required. 

3.1.5. Stiffness 

In real environmental situations, static and dynamic excitations can act on a 
robot. A static excitation can be, for example, a load that is carried by the 
robot. Impulses that occur when placing the foot on the ground lead to dynamic 
excitations. Further impulses can occur in case of interactions with objects. The 
stiffness of the leg structure determines how it reacts on these excitations. By 
using a hexapod, the robot’s stiffness is inherently higher than the stiffness of 
humanoid robots with knees. 

The stiffness is determined by a global stiffness matrix, which is derived 
from the resilience of the drives. Since the drives are connected to universal 
joints at their ends, no bending moments appear. The purely axial loads allow 
to model the drives as tie bars or struts. Here, the elasticities of further compo¬ 
nents are not considered explicitly. Instead, they are considered by a high safety 
factor. From the diagonal elements of the stiffness matrix, the rigidities can be 
determined in every direction of the world coordinate system, and the influence 
of off-diagonal elements is disregarded. 

4. New Prototype of the CENTAUROB 

4.1. Redesign Process 

The first prototype of a parallel two-legged walking robot was a breakthrough 
in technology and base for further engineering. The vision of creating a mo¬ 
bile robot which can operate autonomously and automatically recognize obsta¬ 
cles as well as overcome them implies using an independent power supply, a 
stand-alone control system, and compliance to essential safety requirements in 
human surroundings. For this reason, the CENTAUROB underwent a complete 
redesign in which every mechanical component was thoroughly reviewed to re¬ 
duce weight as well as increase dynamics and efficiency [7]. 

As a first step in the redesign process, an optimization of the Stewart plat¬ 
form architecture was suggested. The circular shape of the Stewart platforms 
attached to the hip was changed to an elliptical shape with a smaller diameter 
only in the lateral direction, see Fig. 4. Therewith, the lateral dimension of the 
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(a) 



(b) 


Figure 4. Redesign of the robot’s hip: (a) original, circular hip, and (b) opti¬ 
mized, elliptical hip with reduced lateral dimension. 


hip can be reduced to a more human-like one. Furthermore, the width of the hip 
determines the flexibility of the robot as it limits the opportunity to pass through 
narrow passages. By this means, the good performance in the dominant forward 
direction can be preserved in combination with a narrow hip size. Other changes 
in the mechanical components include a replacement of the formerly used step¬ 
per motors by high performance electronically commuted servomotors and the 
sliding screws by low-friction ball screws, which require brakes in case of a 
power or control failure since the new mechanism is not self-locking. Due to the 
low coefficient of performance, instead of worm gears, we now use belt drives 
and planetary gears between the spindles and motors. In order to compensate 
the passive rotation of the upper cylinder around the spindle axis [15], an upper 
joint with an extra degree of freedom of rotation is possible. A more sophisti¬ 
cated possibility is a compensation of the passive rotation by using quaternions 
as proposed in [16]. Therewith, universal joints can be used for the upper and 
lower joints as well. The new prototype of the CENTAUROB is illustrated in 
Fig. 5. 

4.2. Structural Design of the New Prototype 

The main modules of the CENTAUROB are the hip, the upper joints, the legs, 
the lower joints, and the feet. The main components of the robot are briefly in- 
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Figure 5. New prototype of the CENTAUROB. 


troduced in the following. A more detailed description of the robot’s mechanical 
structure is given in [5]. 

4.2.1. Hip 

The hip, which is the connecting structure between the legs of the robot, con¬ 
tains the motor cards, the power supply, and the on-board control system. The 
size of the hip is 720 mm in the lateral direction and 500 mm in the longitudinal 
direction and is adapted to the positions of the upper joints. The upper joints 
of each hexapod are arranged side by side in an ellipse instead of a circle to 
provide a narrow hip size as described in Section 4.1. 

4.2.2. Joints 

As upper and lower joints, we use state-of-the-art universal joints made of stain¬ 
less steel with two degrees of freedom and a pivot angle of 45°. In this case, 
the passive rotation that results from the asymmetric transformation of rotations 
in the universal joints, must be mathematically formulated and computationally 
compensated [15], [16]. 
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4.2.3. Legs 

The legs of the robot are composed of six linear units that are combined to a 
hexapod. Each linear unit itself consists of a ball screw linear actuator and a 
parallelly arranged motor unit. Both are connected by a cam belt. 

The motor unit consists of an electrically commutated DC motor, a motor 
card, which is placed on the hip, a break, and a planetary gear. The motor card 
allows a position, velocity, and current control. Furthermore, the motor contains 
Hall sensors and a three-channel encoder to detect the angular position of the 
motor shaft and therewith the length of the linear actuator. The brake is used to 
hold the position in case of an electricity failure, and the interposed planetary 
gear leads to a higher torque in the linear actuator. 

The cam belt transmits the motor’s torque one-to-one to the linear actuator. 
Then, the ball screw converts the torque into a linear movement. The linear 
actuator consists of an upper cylinder with an integrated spindle and a lower 
cylinder, which can move in linear direction. Strain gauge force sensors are 
used at the end of each linear unit for measuring the forces along the spindle. 

4.2.4. Feet 

The special C-shape of the feet leads to a convex standing surface containing the 
ground projection of the robot’s center of mass, see Fig. 2. The hip of the robot 
can be moved as long as the ground projection of the center of mass remains in 
the standing surface. Due to the special shape of the feet, it is also possible to 
place the smaller foot inside the bigger foot. When the feet are placed inside 
each other, the height of the CENTAUROB from the ground to the bottom edge 
of the hip is 872 mm in the retracted and 1269 mm in the extended condition. 

4.3. Sensor Architecture 

The global sensor concept for the CENTAUROB contains the so-called pose 
detection, the force-measurement, and the detection of the ground projection of 
the robot’s center of mass. 

4.3.1. Pose Detection 

Six minimal coordinates are necessary to determine the pose of a six degree 
of freedom parallel mechanism. In order to determine the pose and orienta¬ 
tion of such a mechanism, generally, the lengths of the six linear actuators are 
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measured. This so-called direct kinematics problem is quiet difficult to solve 
because there is usually not a unique solution. It is necessary to search iter¬ 
atively for the platform’s positions and orientations with the need of an initial 
pose estimate. The accuracy and convergence time depends on the choice of this 
initial pose estimate. Many studies have been made in this field. In order to find 
a unique solution for a given set of actuator lengths, it is possible to add further 
sensors on the passive joints of the hexapod [17], [18], [19], and others. Two 
possibilities of the placement of sensors have been investigated. One possibility 
is to add rotary sensors on existing passive joints, and the other possibility is to 
add passive links whose lengths are measured with linear sensors. 

For an electric driven linear actuator, it is indeed possible to detect its length 
with a rotary encoder. Rotary encoders provide precise values of the angular po¬ 
sition of the motor shaft, which, in turn, is related to the linear actuator’s length. 
This length, on the other hand, needs to be linked with the encoder position by 
performing an initial length measurement. Due to a possible backlash in the 
gear or the spindle, the flexibility of the belt, or the so-called passive rotation in 
unguided ball screw linear actuators, the obtained data do not have to comply 
with the actual linear actuator’s lengths necessarily [15], [16], [20]. An addi¬ 
tional compensation or a numerical real-time estimator, as suggested in [20], 
needs to be implemented. 

Although the lengths of the linear actuators are needed, for example, as 
target values for the motors, the position and orientation of the platforms are 
more valuable. One reason for this is, for example, the use of these values as a 
reference signal in control. Furthermore, using inverse kinematics (see Section 
5), the linear actuator’s lengths can be obtained from the platform’s positions 
and orientations. 

As mentioned before, for incremental length sensors, an initial length mea¬ 
surement or a so-called homing, an initialization run to predefined reference 
signals, is necessary. For absolute length sensors, the accuracy decreases with 
increasing measuring range. Furthermore, the installation range and the cost 
also increase. 

For the two-legged walking robot CENTAUROB, several sensor concepts 
have been studied. Four sensor concepts using only the minimum number of 
sensors were proposed and presented in detail in [21]. These concepts still need 
further numerical methods to find the unique pose of the robot. They are de¬ 
scribed in the following. 
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Six angle sensors are mounted on the six linear actuators of the hexapod to 
detect the orientation of each linear actuator. Therewith, manufacturing costs 
can be reduced because the linear actuators can be constructed identically. A 
problem here is that even small angle changes can result in major changes in the 
linear actuators’ length. 

Six displacement sensors are mounted on the six linear actuators of the 
hexapod. These sensors detect length changes in the ball screws of the linear 
actuators. In this context, different types of displacement sensors can be imple¬ 
mented. For example, it is possible to implement displacement sensors where 
the measuring armature dips into a core, a magnet is moved along a track, or the 
length is detected with a rope. The advantage of using displacement sensors is 
the high and uniform accuracy of the measurement. Even for simple executions, 
these measuring units achieve an accuracy of up to 0.25 mm. This accuracy is 
approximately constant for the entire stroke of the linear actuator. Moreover, 
displacement sensors can directly detect length changes of the linear actuators. 
The main disadvantage of displacement sensors, however, is that most of them 
are quiet large and must be mounted directly on the ball screw linear actuators. 

Three angle sensors and three displacement sensors are mounted on three 
linear actuators to combine the advantages of both sensor concepts. Thus, the 
lengths of the linear actuators can be measured with displacement sensors and 
the orientation of the foot can be determined by angle sensors. Thereby, the 
space required for the sensors is minimized so that the workspace is only as lim¬ 
ited as possible. In particular, due to the serial arrangement of the two hexapods 
of the CENTAUROB, the workspace of the legs is already limited. In order to 
achieve an optimal sensor placement, the sensors can be mounted on the outer 
linear actuators of each leg so that collisions or interference with other leg’s 
sensors can be excluded. 

Six inclination sensors are mounted on the six linear actuators of the hexa¬ 
pod. With these sensors, the position of the feet in relation to the hip can be 
determined. In addition, this sensor concept even provides information about 
the position and orientation of the robot in space. 

In order to elude the direct kinematics problem, further concepts were stud¬ 
ied in [21]. In these concepts, the unique solution of the direct kinematics prob¬ 
lem can be obtained by using only the sensor data. This is generally achieved 
by means of additional sensors. Five different sensor concepts were proposed 
and presented in detail, which are described in the following. 
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Five angle sensors and one displacement sensor: By attaching one angle 
sensor on the linear actuator, two angle sensors on the lower joint, three angle 
sensors on the upper joint, and one displacement sensor on the linear actuator, 
the pose of this linear actuator is clearly determined just like the pose of the 
end-effector. The disadvantage of this concept is that all the sensors have to be 
placed on just one linear actuator. This might lead to difficulties in mounting 
the angle sensors on the joints or to limitations of the workspace. 

Five angle sensors and one displacement sensor on an additional leg: 
An additional leg can be integrated in the middle of the hexapod. The leg can 
be made of a non-rotatable telescopic cylinder mounted between the upper and 
the lower platform. The length of the additional leg can be measured by the 
displacement sensor. The advantage of this concept is the possibility to avoid 
sensors on the linear actuators. In this context, angle sensors can be integrated 
much easier in the additional leg than in the joints of the linear actuators. 

Four angle sensors and three displacement sensors: In this concept, two 
angle sensors and one displacement sensor are mounted on two linear actuators 
of the hexapod. Therewith, two vectors of known lengths and orientations are 
defined. The endpoints lie both on a plane indicating the orientation of the 
foot. Here, a straight line between these two points can be drawn. However, 
the rotation around the longitudinal axes of these two linear actuators is still 
undetectable. With an additional displacement sensor on another linear actuator, 
the pose of the foot can be obtained. 

Four angle sensors, two displacement sensors, and three one¬ 
dimensional inclination sensors: Similar to the previous concept, two linear 
actuators are each equipped with a displacement sensor and two angle sensors 
at the universal joints. Therewith, again, a line on the foot platform is known. 
In this context, the plane through this line can only rotate around this line. The 
only remaining degree of freedom can be detected by means of an inclination 
sensor on the hip. However, this is only possible if the orientation of the foot 
platform with respect to the global coordinate system is known. Since this is 
not always the case, another inclination sensor on the foot is necessary to obtain 
meaningful data for calculating the hexapod’s pose. Comparing the inclination 
of the hip and the foot platform, an angle between the two planes can be de¬ 
termined. The inclination sensors must be positioned so that they are mounted 
on the hip and the foot each in a perpendicular direction to the connecting line 
between the two linear actuators equipped with the other sensors. 
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Six displacement sensors and two angle sensors: In a concept with six 
displacement sensors, where each sensor is mounted on one linear actuator, di¬ 
rect kinematics offers up to 40 different poses for the robot [22]. With two addi¬ 
tional angle sensors on two of the linear actuators, wrong poses can be excluded 
until only the correct solution remains. 

4.3.2. Load Detection 

Static stability can only be guaranteed if the ground projection of the robot’s 
center of mass constantly remains in the stability region spanned by the C- 
shaped feet of the CENTAUROB, see Fig. 2. This point can be calculated from 
the forces along the linear actuators. Therefore, strain gauge force sensors are 
installed at the end of every linear unit. This makes it possible to measure the 
load of every leg. Furthermore, by knowing the actual pose of the CENTAU¬ 
ROB, the ground projection of the center of mass can be calculated using static 
equilibrium equations. In a static situation, the robot’s center of mass can be 
calculated by the weights and positions of every center of mass of the individual 
component. 

5. Kinematic Model 

In this section, we review the kinematics of the linear actuators of the CEN¬ 
TAUROB. The complete description of the kinematics can be found in [5]. 

5.1. Kinematics of the Free Rigid Body 

The kinematics of a body describes its possible movement without considering 
the cause of this movement, that is, the forces acting on the body. The move¬ 
ment of a single, free rigid body can be described by two different coordinate 
systems, a body-fixed one and an inertial one. The coordinate systems of the 
CENTAUROB are illustrated in Fig. 6. Here, {0} denotes the inertial frame and 
{i}, i = 1,..., 4, denote the body-fixed frames. 

The position and orientation of a platform can be described by the following 
vector of minimal coordinates: 

Vi=[Px,i Py,i Pz,i OLi (3i Ji] T = \y t ,i Vr,i] T , i = l,...,4, (1) 

where y t i contains the translatory and y T i the rotatory degrees of freedom of 
the platform. Furthermore, p x ^ shows in the forward, p y ^ in the sideward, and 
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p Zi i in the upper direction of the robot. The rotation angles ai, fa, and 7 ^ can be 
defined, for example, by CARDAN or EULER angles. 

On the other hand, we can also use the lengths of the linear actuators q l 
k = 1 ,..., 6 , for defining the minimal coordinates: 

Qi=[qi,i <72,i <73 ,i <74 ,i <75 ,i Q6,i] T ’ i = l,...,4. (2) 

In order to transform an arbitrary vector l p described in the body-fixed 
frame {i}, i = 1,..., 4, into the inertial frame {0}, we use the following rela¬ 
tion: 

p = Pi + Ri • % p , (3) 

where p i denotes the vector connecting the origins of frame { 0 } and frame {i} 
and Ri the rotation matrix from frame {z} into frame {0}. Note that, here, 

Pi = Vt,i • ( 4 ) 

Because the rotation angles in Eq. (1) do not span an orthogonal coordinate 
system, their temporal derivatives do not represent a geometrically meaningful 
quantity. For this reason, we have to introduce a new vector of minimal coordi¬ 
nates which only contains velocities: 

— \px,i Py,i Pz,i ^x,i &y,i ^z,i\ ~ \ijt^i\ i 


i = l,.--,4. 

(5) 
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Here, uo x ^, u y and u Z)l denote the angular velocities around the the x , y , and 
z direction, respectively. Note that 

^i ~f~ Vr,i * (6) 

However, between u.\ and y Y ^, the following relationship holds: 

v x ,i [1 0 sin ^ 1 |~<A 

Ui = Uyj = 0 cos oii - sin a* cos A ‘ A = 2/ r? * , (7) 

0 sin cos ol{ cos A A 

assuming that c^, Pi, and 7 ^ are defined by CARDAN angles. 

5.2. Inverse Kinematics of the CENTAUROB 

The inverse kinematics describes the relationship between the actuator coordi¬ 
nates of the active bodies q { , i = 1,..4, and the world coordinates y { , as 
illustrated in Fig. 7. For a hexapod, the world coordinates y { cannot be com¬ 
puted directly. For this reason, we use the actuator coordinates q { as a reference 
signal in our control system. 



Figure 7. Relationship between the world and the actuator coordinates. 
According to Fig. 8 , the length of the fcth linear actuator 

?fc,i = ?fc,2 = |Pj M J M l = |Pj M J M l» As = 1,..6 , (8) 

can be determined from 

2 Pj k , 2 J k ,i = 2 P2i + 2 Ri ' *Pij M - 2 P 2 j fc , 2 (9) 

with respect to the temporarily fixed frame {2}. Here, 2 R\ denotes the rotation 
matrix from frame { 1 } into frame { 2 }. 
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Figure 8. Schematic diagram for determining the length of a linear actuator. 


For a given velocity vector 0^, i = 1,..4, the velocities of the linear 
actuators q { can be always determined by means of the inverse (geometrical) 
JACOBI matrix Jr 1 : 


d Qj 1 d Oj 
d t i ' dt ' 


( 10 ) 


Because of the modular design of the CENTAUROB, only four structurally 
different inverse JACOBI matrices are needed: 


• inverse JACOBI matrix of the linear actuators, 

• inverse JACOBI matrix of the joints, 

• inverse JACOBI matrix of the upper cylinder units, 

• inverse JACOBI matrix of the lower cylinders. 

In the following, we will review the inverse JACOBI matrix of the linear 
actuators. For the derivaion of the other inverse JACOBI matrices, the reader is 
referred to [5]. 
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5.3. Inverse JACOBI Matrix of the Linear Actuators 

The velocities of the linear actuators 1 , k = 1,..6, can be determined from 
d 1 T 

Qk,i = -ti\Pj K2 j k1 \ = ]- | -Pj k , 2 Jk,i ~PJk,2J k ,i • ( U ) 

dt I PJk, 2 Jk,i\ 

By using the relation 

0 i ^y,i 

R% • R^ — i— UJ z ,i 0 ^x,i •> ( 12 ) 

_ ^y,i ^x,i 0 

the temporal derivative p Jk 2 Jfc ] can be calculated from 

Pjk, 2 Jk,l = P21 + Wl • Pu fcit • (13) 

Substituting in Eq. (11) and simplifying results in 


4m - 73 T • (p 21 + PlJfc.i _ P2J fc , 2 ) • P'2l 

\Pjk,2Jk,l\ L V 7 

+ (piJ M • (p 2 l-P 2 J fci2 )) T -Wl • 


(14) 
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6. Control Concepts 

The motion control strategy for the CENTAUROB consists of three parts: the 
execution of user commands or wishes, the stability control, and the position 
control. Although the core of the strategy is formed by the execution of user 
commands or wishes, the parts are structured as a three-step cascade. The sta¬ 
bility control is designed to ensure static stability at all times while the position 
control should make sure that the target position is always reached. All parts 
work independently of each other by using different control parameters as well 
as query and intervention times. 

6.1. Execution of User Commands 

Generally, the movement of the CENTAUROB can be classified into statically 
stable and dynamic movement. Here, we will concentrate on the statically stable 
movement. Furthermore, it has to be distinguished between a single-step and a 
multi-step movement. In the single-step movement, the robot makes only one 
step, whereas, in the multi-step movement, the CENTAUROB can reach a target 
position out of his working area by making several steps. This requires a more 
complex program than in the single-step movement. However, both movements 
are nearly the same except that in the multi-step movement, the CENTAUROB 
still has a command in mind after one step was made. 

The overall user command execution concept is structured as follows. After 
a command is entered, it is checked for its sense. Furthermore, it is necessary 
to check if the parameters (these are, for example, the maximum and minimum 
velocity, the acceleration, and the step size) remain in their boundaries. For this 
reason, the robot’s pose must be known exactly. The step size, for example, 
depends on the height of the hip and the step height, as illustrated in Fig. 9. 
We can see that the maximum step size of 680 mm can be reached at a hip 
height of 937 mm. In the retracted or extended hip condition, no step size can 
be approached. 

The verification of the user command is followed by the calculation of the 
motion trajectories for every part of the motion by using the inverse kinematic 
model from Section 5. The calculated trajectories are used to simulate the mo¬ 
tion and to check the parameters one more time. After the trajectory is suc¬ 
cessfully checked, the trajectories are enabled and sent to the motors. After 
the user command is executed, the CENTAUROB returns to the initial position, 
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Figure 9. Step size of the CENTAUROB in longitudinal direction as a function 
of the hip height and the step height. 


phase zero, and the program is waiting for the next command. The overall user 
command execution concept can be viewed as a loop starting with an entered 
command and returning to the initial position after executing this command, see 
Fig. 10. 

6.2. Stability Control Concept 

Static walking can be realized if the acceleration of the hip and the resulting 
forces of the moving bodies can be neglected. This is possible if the weight of 
the hip is significantly higher than the weight of each leg and the movement of 
the hip is relatively slow. Static stability can then be reached if the ground pro¬ 
jection of the robot’s center of mass constantly remains in the stability region, 
see Fig. 2. It can be calculated from the data of the force sensors as described 
in Section 4.3.2. 

6.3. Position Control Concept 

The position control concept is used to make sure that the CENTAUROB 
reaches his target position. This can be realized, for example, by a very long 
interference time. This means that the execution of user commands and the sta- 
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Figure 10. Overall user command execution concept for the motion control. 

bility control act faster than the position control. Therewith, it is ensured that 
stability is given and the user commands are executed properly. This concept 
leads to long follow-up times until the target position is finally reached. Further¬ 
more, large differences between the actual and the target position are possible, 
which could cause collisions. 

6.4. Power Control Concept 

On top of the hip, two rechargeable batteries with 24 V DC are installed to 
supply the electrical components. These are the servo motors supplied by their 
motor cards and the breaks that are needed to hold the motor’s position in case of 
an electricity failure. The batteries use lithium anodes and nickel-manganese- 
cobalt cathodes which leads to a very high specific energy. In order to have 
two independent legs with their own power supply, it is useful to separate the 
power supply of each leg. Because the non-constant load on the feet during one 
step results in a non-constant power consumption, it is necessary to analyze the 










The Parallel Two-Legged Walking Robot CENTAUROB 


127 


consumed current during one step. 

In this context, three kinds of foot loads must be distinguished that appear 
in the following phases: the double support phase, the single support phase, 
and the swing phase. In the double support phase, both feet stand still on the 
ground, and the load of the hip is distributed more or less symmetrically on the 
feet, depending on the position of the hip and the ground conditions. In this 
configuration, each leg requires nearly the same current, which can be easily 
calculated for static conditions. Here, the whole load is concentrated on only 
one leg because the other leg is in the so-called swing phase. In the swing phase, 
one leg is moved to its target position, so the motors of this leg only have to 
carry the weight of the corresponding foot. In this phase, the leg is stressed with 
a tensile load whereas in the other phases, the leg is stressed with a compressive 
load. 
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Figure 11. Overall current consumption / over time t during a walking step. 

The three phases alternate during the motion process. The overall current 
consumption during a walking step is shown in Fig. 11. In order to reduce 
the average current that lays between the currents of the double support phase 
and the single support phase, the holding breaks can be used during the single 
support phase. Another strategy to reduce the average current is the optimization 
of the walking pattern and trajectory by the parameters step size, step height, 
step velocity, and acceleration. 
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7. Walking Scenario Simulations 

In order to prove the agility of a robot with two serially arranged parallel kine¬ 
matics, several walking scenarios were simulated. Although the robot’s focus 
is walking forwards, it is still possible to walk sidewards, climbing straight and 
spiral stairs, overcome obstacles, turning around, and some more special fea¬ 
tures. The workspace boundaries are illustrated in Fig. 12. 



Figure 12. Visualization of the robot’s workspace boundaries: ±680 mm in lon¬ 
gitudinal and lateral direction with respect to the center points of the hexapods. 


7.1. Walking Pattern 

The statically stable movement of the CENTAUROB can be divided into six 
phases, where phase zero builds the so-called initial situation. In this initial 
situation, the CENTAUROB has finished the last movement or is freshly started, 
and the program is waiting for a user command. The phases one to five are 
part of every movement of the CENTAUROB. The only parameters that change 
are the hip height, the step length and height, the speed, and the orientation of 
the feet. Starting from the initial position where the CENTAUROB stands still 
with both feet central under his hip (see Fig. 5), in phase one, the hip is moved 
over the bigger foot to increase the stability and to relieve the other foot, see 
Fig. 13(a). 

In phase two, the released foot moves along the calculated trajectory towards 
the target position, where the hip and the other foot remain still, see Figs. 13(a)- 
(b). This trajectory is quite complex because in the initial position of the feet, the 
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(a) (b) (c) (d) (e) 

Figure 13. Motion states of the CENTAUROB. 


bigger foot nearly surrounds the smaller foot. There are three different possible 
trajectories for reaching the target position without any foot collisions. One 
possibility is to lift the smaller foot to the height of the bigger foot and then to 
start the trajectory. The second possibility is to move the smaller foot sideways 
out of the bigger foot and then to start the trajectory. Finally, it is also possible 
to move one of the feet with a complex trajectory that prevents all collisions by 
precalculation. Therefore, the actual position and the size of the feet have to be 
known exactly. 

In phase three, the hip moves from the position above the bigger foot to the 
one above the smaller foot, see Figs. 13(b)—(d). Depending on the weight of the 
hip, it might not be necessary to place the hip directly above the smaller foot. 
This would make it possible to move the hip straight in the direction of the target 
without any lateral movement. 

In phase four, the bigger foot is moved under the hip, see Figs. 13(d)—(e). As 
mentioned in phase two, a complex trajectory is useful to prevent from any foot 
collision. Therefore, a fifth phase is necessary to move the hip into the initial 
position in the middle of the feet if a hip movement above the stable standing 
foot was necessary in the former phases, see Fig. 13(e). 

In order to achieve an ’economic’ walking, several modifications on the 
walking pattern described above were made. In this context, ’economic’ means 
to use an optimized force distribution on the linear actuators to reduce the cur¬ 
rent consumption of the batteries and increase the walking range. Furthermore, 
’economic’ stands for a walking pattern that is definite, easily adjustable, with 
low complexity, and identical for both feet. 

In phase one and five, a hip movement between zero and 160 mm is required 
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(a) (b) (c) 

Figure 14. Ground projection of the robot’s center of mass (GPCoM) at hip 
displacements of (a) 0 mm, (b) 100 mm, and (c) 160 mm. 


to stabilize the motion process. This hip movement over the bigger foot reduces 
the forces along the linear actuators in the supporting leg. The ideal amount 
of hip movement depends on the weight of the hip because it affects the forces 
along the linear actuators as well as the lever arm of the tipping torque by the 
height of the center of mass. For example, when moving the hip for 100 mm, the 
forces along the linear actuators are reduced to 55% of the forces with no hip 
movement. For a hip movement of about 160 mm, the forces along the linear 
actuators are even reduced to a third. Figure 14 shows the ground projection of 
the robot’s center of mass for different hip displacements. 

There are a few parameters influencing the foot trajectory. The step size, for 
example, has two limits, the minimum step size, which is 238 mm and results 
from the shape of the feet, and the maximum step size that depends on the step 
height, the hip movement during a walking step, and the height of the hip as 
shown in Fig. 9. 

Phase three, where the hip is moved from the position above the bigger foot 
to the one above the smaller foot, is necessary to move the center of mass from 
the position above one foot to the position above the other foot. The trajectory 
is statically stable because in this so-called double support phase, the ground 
projection of the center of mass always remains in the stability region formed 
by both feet standing on the ground as illustrated in Fig. 15(a). Figure 15(b) 
shows the ground projection of the robot’s center of mass for a whole walking 
step. 

For huge step sizes, for example, 680 mm in longitudinal or 640 mm in lat¬ 
eral direction, in phases one and four, it gets necessary to move the hip contrary 
to the moving direction of the CENTAUROB. This ensures that the ground pro- 
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(a) (b) 



(c) 


Figure 15. Ground projection of the robot’s center of mass (GPCoM): (a) in 
phase three, (b) for a whole walking step, and (c) for huge walking steps with 
and without additional hip displacement. 


jection of the center of mass remains in the stability region. Figure 15(c) shows 
the differences of the ground projection of the center of mass with and without 
an additional hip movement in the phases one and five for forward walking. 

7.2. Walking Forwards and Sidewards 

The forward walking of the CENTAUROB is already described above. Addi¬ 
tionally to this movement, where the second foot only follows the first one, it 
is also possible to perform human-like steps where one foot overtakes the other 
one. Both forward movements have their advantages. For example, the first sce¬ 
nario leads to lower forces in the linear actuators and therewith to a lower current 
consumption. Furthermore, it preserves a higher amount of stability since the 
displacement of the ground projection of the center of mass in the walking di¬ 
rection in phase two depends on the step size. The second scenario is a more 
familiar motion. Due to the omission of an intermediate step, a higher moving 
velocity for the same step sizes and step velocities can be achieved. This second 
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moving scenario, however, has a disadvantage in terms of an economic walking 
pattern. After one step, the robot is not in its initial pose. In order to return to 
the initial, stable pose, another step is necessary. Both walking scenarios with 
its differences are illustrated in Figs. 16 and 17. 



Figure 16. Moving forwards, sequence one: Moving the hip above the bigger 
foot (a)-(b), lifting the smaller foot (b)-(c), moving the smaller foot forwards to 
the target position (c)-(d), moving the hip above the smaller foot (d)-(e), lifting 
the bigger foot (e)-(f), moving the bigger foot forwards to the position next to 
the smaller foot (f)-(g), moving the hip to the initial position above the middle 
of the feet (g)-(h), starting the next step again with the hip movement (h)-(i). 

In order to avoid obstacles, it might be useful to walk sidewards instead 
of turning around and walking forwards. The sideward movement, shown in 
Fig. 18, mainly equals the forward movement. The main difference between 
these movements in the walking pattern is the larger hip movement that is nec- 
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(a) (b) (c) (d) (e) 



(f) (g) (h) (i) 


Figure 17. Moving forwards, sequence two: Moving the hip above the bigger 
foot (a)-(b), lifting the smaller foot (b)-(c), moving the smaller foot forwards to 
the target position (c)-(d), moving the hip above the smaller foot (d)-(e), lifting 
the bigger foot (e)-(f), moving the bigger foot forwards to the target position in 
front of the smaller foot (f)-(h), moving the hip above the bigger foot (h)-(i). 


essary to achieve stability during walking. This hip movement is contrary to the 
moving direction. 

7.3. Special Features 

Due to the six degrees of freedom of the hip and each foot, the robot provides 
plenty of special moving features. In case an obstacle shows up or it becomes 
necessary to climb steps or stairs, the robot can change the height of the hip as 
well as the step height. Therewith, it is not only possible to overcome small 
obstacles with heights up to 350 mm and lengths up to 300 mm, as shown in 
Fig. 19, the robot can also climb steps and stairs with rises up to 400 mm, as 
shown in Fig. 20. 

For statically stable walking, two cases for overcoming an obstacle are pos¬ 
sible. In the first case, the obstacle is small enough to overcome it within one 
step. Here, no additional or only little hip movement is necessary so that the 
ground projection of the robot’s center of mass remains in the stability region. 
In the second case, the obstacle has an even surface to place a foot on top of 
the obstacle. Here, the obstacle is passed within two or more steps. It is also 
possible to overcome bigger obstacles but not for statically stable walking. 
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Figure 18. Moving sidewards: Moving the hip above the bigger foot (a)-(b), 
lifting the smaller foot (b)-(c), moving the smaller foot sidewards to the target 
position (c)-(d), moving the hip above the smaller foot (d)-(e), lifting the bigger 
foot (e)-(f), moving the bigger foot sidewards to the position next to the smaller 
foot (f)-(g), moving the hip to the initial position above the middle of the feet 
(g)-(h), starting the next step again with the hip movement (h)-(i). 


In order to operate in any environment, it is essential not only being able to 
walk a curve but also being able to turn around. For example, in tight hallways, 
there is not enough space to turn in a curve. Due to the specially C-shaped feet 
of the CENTAUROB, it is possible to turn around nearly at a point and with only 
a few steps. Figure 21 shows the scenario for the robot rotating by 90 degrees. 

By combining the two motions, climbing stairs and turning around, the robot 
is able to walk spiral staircases as shown in Fig. 22. This is only possible be¬ 
cause of the special C-shaped feet. For the shown movement, the center of the 
hip never leaves the stability region formed by the feet. This motion makes 
the CENTAUROB a unique moving device with several possible applications as 
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(a) (b) (c) (d) (e) (f) 



(g) (h) (i) 


Figure 19. Overcoming obstacles: Lifting the hip to the designated height (a)- 
(b), moving the hip above the bigger foot (b)-(c), lifting the smaller foot above 
the height of the obstacle (c)-(d), moving the smaller foot above the obstacle to 
the target position (d)-(e), moving the hip above the smaller foot (e)-(f), lifting 
the bigger foot above the height of the step (f)-(g), moving the bigger foot to the 
position next to the smaller foot (g)-(h), moving the hip to the initial position 
above the middle of the feet (h)-(i). 


will be discussed in the next section. 


8. Fields of Usage and Applications 

As a universal moving platform, the CENTAUROB can be used in several ap¬ 
plications and environments. One possible field of usage is, for example, the 
industry. An assisting or fully autonomous employment of robots in unpaved 
terrain will play an important role in the future. Despite of the working area, a 
lot of jobs will be transferred to robots due to their precision, velocity, safety, 
and endurance. Here, parallel two-legged robots can be used, for example, as 
industrial carrying devices in undefined environments ore even as autonomous 
robots in rough or dangerous areas. 

Another aspect, that must be thoughtfully treated, is the increasing average 
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(a) (b) (c) (d) (e) 



(f) (g) (h) (i) 


Figure 20. Climbing straight stairs: Lifting the hip to the designated height (a)- 
(b), moving the hip above the bigger foot (b)-(c), lifting the smaller foot above 
the height of the step (c)-(d), moving the smaller foot to the target position (d)- 
(e), moving the hip above the smaller foot (e)-(f), lifting the bigger foot above 
the height of the step (f)-(g), moving the bigger foot to the position next to the 
smaller foot (g)-(h), moving the hip to the initial position above the middle of 
the feet (h)-(i). 


age of our society. Despite of this fact, the aim to preserve a self-determined life 
with coping daily routines becomes stronger. However, for older people, after a 
certain point in time, assistance and/or care become inevitably necessary. In this 
context, a survey in Germany found out that the majority of the German citizens 
does not want to move into a retirement home in old age [23]. Two-thirds of 
the respondents want to live in an apartment or a house when they are old and 
only 15% prefer a nursing or retirement home. Nowadays, mobility and certain 
independence have a high individual and social value. Furthermore, they are an 
important aspect of freedom and self-determination, that is, dignity. 

One possibility to retain the mobility of elderly people is by means of techni¬ 
cal support. Wheelchairs and rollators usually require flat environments without 
fixed or exposed obstacles. Fixed obstacles are, for example, door thresholds in 
the apartment or terrace entries. Making things worse, wheelchairs and rolla¬ 
tors have often to be lifted or carried to get, for example, in the apartment or 
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Figure 21. Rotating around 90 degrees: Moving the hip above the bigger foot 
(a)-(b), lifting the smaller foot (b)-(c), turning the smaller foot (c)-(d), rotating 
the hip and moving it above the smaller foot (d)-(e), lifting the bigger foot (e)- 
(f), rotating and moving the bigger foot to the target position (f)-(h), rotating the 
hip and moving it above the smaller foot (h)-(i), lifting the smaller foot (i)-(j), 
turning the smaller foot (j)—(k), moving the hip to the initial position above the 
middle of the feet (k)-(l). 


in a public transportation vehicle. In case of using a stair lift, the person even 
has to change seats which might be a huge effort or even not be possible at 
all. However, so far, existing system improvements have not shown any sig¬ 
nificant progress in overcoming these issues. For this reason, using wheels as 
locomotion concept for elderly people might be reconsidered on behalf of using 
a two-legged walking robot. 

Conclusion 

In this chapter, we reviewed the parallel two-legged walking robot named CEN¬ 
TAUROB, a novel robot system for statically stable walking. Due to the uni¬ 
versal moving platform, the robot offers plenty of possible applications, for 
example, as a sustainable mobility assurance in the assistance and care or as 
an assisting or fully autonomous industrial robot in unstructured or dangerous 
environments. By using two serially arranged parallel kinematics (hexapods) as 
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(a) (b) (c) (d) (e) (f) 



(g) (h) (i) 


Figure 22. Climbing spiral stairs: Lifting the hip to the designated height (a)- 
(b), moving the hip above the bigger foot (b)-(c), lifting the smaller foot above 
the height of the step (c)-(d), turning the smaller foot and moving it to the target 
position (d)-(e), turning the hip and moving it above the smaller foot (e)-(f), 
lifting the bigger foot above the height of the step (f)-(g), turning the bigger 
foot and moving it to the position next to the smaller foot (g)-(h), turning the 
hip and moving it to the initial position above the middle of the feet (h)-(i). 


leg structures, this system totally renounces the use of wheels as the locomotion 
concept which provides high mobility in every direction and enables walking in 
unpaved terrain as well as the handling of steps, stairs, and low clearances. In 
order to prove the agility of the universal robot, several walking scenarios such 
as moving forwards, backwards, and sidewards as well as other motions were 
presented. 

We also described the generation of an economic walking pattern for stati¬ 
cally stable walking of the CENTAUROB. In order to minimize the calculation 
effort, the movement of the robot is separated into as few segments as possi¬ 
ble. This is why for a whole step of the robot, only five different trajectories 
are needed, whereby the trajectories for both feet are identical. Furthermore, 
we described the necessary hip movement to reduce the forces among the linear 
actuators and to improve the stability. 

In order to detect the actual pose of the CENTAUROB and its orientation 
relative to the ground, several sensor concepts were presented and discussed. 
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Knowing the pose of the robot, it is possible to focus on the localization and path 
planning in an unknown environment. An algorithm for robot path planning and 
obstacle avoidance was already developed at our workgroup [24]. 

At the current project level, we consider a walking pattern based on feed 
forward control using precalculated steps. In the next level, the development of 
a much more sophisticated closed-loop control system is in the focus accompa¬ 
nied by a significantly extended sensor structure that shall provide the position, 
acceleration, as well as visual information. The aim is to establish a real-time 
control that allows an online computation of the entire robot motion with respect 
to its environment. 
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Abstract 

In this chapter, we analyze and robustly control the 6-DOF 3-legged 
Wide-Open parallel manipulator, using a Lyapunov analysis approach. 
The mechanism is evaluated in terms of kinematics, workspace, and dy¬ 
namics. By implementing the dynamic model, tracking control of the 
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moving platform is performed using the nonlinear sliding-mode control 
method. The numerical simulations with desired trajectory inputs attest to 
the excellent performance and robustness of the designed position track¬ 
ing sliding-mode controller, in presence of fast varying uncertain param¬ 
eters and external disturbances, which are common in parallel manipula¬ 
tors. 


1. Introduction 

Parallel manipulators have many distinct advantages over their serial counter¬ 
parts; such as greater stiffness, accuracy, speed, and payload capabilities. Those 
are mainly due to the parallel linkages which distribute the payload and aver¬ 
age out the positioning errors, since without parallel chains, the payload and 
positioning errors accumulate [1, 2, 3, 4]. 

Many researchers have been studying on those manipulators after Gough 
and Whitehall [5] first introduced a 6-DOF parallel manipulator with an ap¬ 
plication in tire-testing equipment, followed by Stewart [6], who designed a 
similar robot to be used as a flight simulator, known as the Gough-Stewart plat¬ 
form. The Gough-Stewart platform consists of two platforms, one fixed and the 
other moving, connected with six extensible legs. Many variants of the Gough- 
Stewart platform have been introduced in the literature for different applications 
[1,7, 8,9, 10,11,12,13, 14, 15]. 

However, the lower number of legs induce less interferences between the 
kinematic chains, enlarging the workspace of the robot. Monsarrat and Gosselin 
[16] designed a 3-legged 6-DOF mobile platform connected to the base by three 
identical kinematic chains using five-bar linkages. Badescu and Mavroidis [17] 
performed the workspace optimization of 3-legged translational UPU and orien¬ 
tational UPS parallel platforms under joint constraints. Lu et al. [18] proposed a 
4-DOF over-constrained RRPU + 2UPU parallel manipulator (PM) with 3 legs. 
Zhang and Zhang [19] proposed a novel 2-DOF parallel manipulator with 3 legs, 
which is applied in vehicle driving simulators. Coppola et al. [20] designed a 3- 
legged self-reconfigurable architecture. It addresses the realm of reconfigurable 
6-DOF parallel mechanisms, for sustainable manufacturing. Azulay et al. [21] 
proposed a 3-legged 6-DOF architecture based on a 3-PPRS topology that can 
achieve high (end-effector) tilt angles with enhanced stiffness. 

The purpose of the present study is to analyze and control the 6-DOF 3- 
legged Wide-Open parallel robot for being used in various applications. The 
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proposed parallel manipulator is a 6-DOF spatial platform mechanism. It con¬ 
sists of a fixed base platform and a moving platform, which are connected by 
three extensible legs. The mechanism enjoys a unique non-symmetric architec¬ 
ture with a frontally open half-plane, enabling it to easily embrace and manipu¬ 
late column-shape objects. 

On the other hand, accurate trajectory tracking control of parallel robots is a 
key system requirement, as these devices must often follow prescribed motions, 
and high performance control strategies can significantly improve the tracking 
performance [22, 4]. Tracking control of parallel robots has been approached 
using both linear and nonlinear control laws [23, 4]. 

There are two design frameworks for the control scheme of the parallel 
robots. One is to design a controller based on the joint space coordinate and the 
other is based on the workspace coordinate. The former is a conventional con¬ 
trol idea, which is used to design a controller to set the actuators’ displacements 
based on the desired displacements computed from the position command of 
the manipulator by inverse kinematics. If the actuators’ displacements are well 
controlled, the moving platform of the parallel manipulator moves based on the 
reference trajectory. Many controllers in the literature are based on the joint 
space coordinate [22, 24, 2]. However, the controllers based on the workspace 
coordinate are directly controlled based on the position of the moving platform, 
and not the actuators. 

The rest of the chapter is organized as follows. In Section 2, the Wide-Open 
parallel mechanism is introduced and described. The architecture of the mech¬ 
anism is analyzed and an experimental evaluation is performed. The kinematic 
analysis of the mechanism is performed in Section 3. Workspace analysis with 
considering different constraints on the spherical joints is presented in Section 
4. In Section 5, inverse and forward dynamic analyses of the mechanism are 
discussed, and a numerical simulation is performed. Position control of the 
robot using the sliding-mode algorithm, as well as illustrative numerical simu¬ 
lations are reported in Section 6. Finally, a general conclusion on the chapter is 
provided in Section 7. 
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Figure 1. (a) Illustration of the 6-DOF 3-legged Wide-Open parallel manipula¬ 
tor. There are two actuators per leg. Rotary actuators are resting on the fixed 
platform, and linear actuators are moving, (b) Kinematic variables of i -th leg 
are shown. Active rotation is 0; around jc,- axis, along with the passive rotation 
of \|/; around «/ axis. A linear actuator sets the length d ;, which is the distance 
between A/ and B t . 


2. The Wide-Open Robot Description 

2.1. The Manipulator’s Architecture 

The schematics of the 6-DOF 3-legged Wide-Open mechanism is shown in Fig¬ 
ure 1 (a). The mechanism is another version of the basic 3-leggd parallel manip¬ 
ulator with symmetrical legs [25, 26, 27]. Each leg is composed of three joints; 
universal, prismatic, and spherical (Figure 1 (b)). A rotary and a linear actuator 
are used to actuate each leg. The rotary actuators, whose shafts are attached to 
the lower parts of the linear actuators through universal joints, are placed on a 
semicircle on the fixed platform. The spherical joints connect the upper parts of 
the linear actuators to the moving platform. 

By replacing the passive universal joints in the Stewart mechanism with ac¬ 
tive joints in the proposed mechanism, the number of legs could be reduced 
from 6 to 3. This change makes the mechanism lighter, since the rotary actua¬ 
tors are resting on the fixed platform, which allows for higher accelerations to 
be available due to smaller inertial effects. More importantly, in the proposed 
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parallel manipulator, the legs are configured non-symmetrically on a semicir¬ 
cle on the base and moving platforms. This frontally wide open architecture, 
enables the mechanism to embrace and manipulate column-shape objects. The 
applications of such mechanism are versatile, from fracture reduction of long 
bones in surgical robotics to column climber robots in industrial robotics. 

As shown in the Figure 1, coordinate C/(A/,x/,y/,z/) is attached to the base 
platform with its x/ axis aligned with the rotary actuator in the x/ direction, and 
its n axis perpendicular to the fixed platform, x/ is rotated by Y/ from the X 
direction of fixed platform coordinate A(0,X,F,Z). The rotary actuators are 
located at the positions A/ (for i = 1,2,3) on the base platform and each shaft 
is connected to the lower part of the linear actuators through a universal joint 
(Figure 1). The upper parts of linear actuators are connected to the moving 
platform, 5/ points, through spherical joints (Figure 1). 

Cartesian coordinates A(0,x,y,z) and 5(P, w,v,w) represented by {A} and 
{5} are attached to the base and moving platforms, respectively. In Figure 1, 
Si represents the unit vector along the axes of i-th rotary actuator and di is the 
vector along A/5/ with the length of d/. Assuming that each limb is connected 
to the fixed base by a universal joint, the orientation of i-th limb with respect to 
the fixed base can be described by two successive rotations, rotation 0/ around 
the axis s/, followed by rotation \|// around tiu which is itself perpendicular to 
both di and s*. It is to be noted that 0/ and di are active joints, actuated by the 
rotary and linear actuators, respectively, while, \|// is an inactive joint. 

2.2. Experimental Evaluation 

The performance of the Wide-Open mechanism was evaluated in an experimen¬ 
tal study on a fully functional prototype of the robot. As shown in Figures 2 and 
3, this prototype has full-circular fixed and moving platforms. Each of the three 
legs is equipped with a rotary actuator located on the base platform. This rotary 
actuator consist of a stepper motor followed by a low-ratio gearbox to enlarge 
the shaft torque. The gearbox shaft is then connected to the lower part of the 
leg using a revolute joint which is made of a miniature needle bearing. Linear 
actuation at each leg is provided using a ball screw system powered by another 
smaller stepper motor. Finally, the spherical joints connect the upper parts of 
the legs to the moving platform. 

In the experimental tests, an optical stereoscopic vision system (Micron- 
Trackers, Claron Technology Inc., Ontario, Canada) was used as an external ob- 
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Figure 2. The fabricated prototype of the 3-legged Wide-Open robot. Full rings 
have been used for both fixed and moving platforms. At each leg, the ball screw 
actuator, driven by a stepper motor, is providing the precise linear motion. The 
rotary motion of each leg is generated by another stepper motor, attached to a 
low-aspect-ratio gearbox. 


server to track the robot’s end-effector, i.e., the center of the moving platform. 
In the setup, the 3D camera detects a set of markers attached to the moving 
platform to find its position and orientation with respect to a fixed Cartesian 
coordinate system, defined using another set of markers attached to the frame. 

In the experimental tests, at first, the workspace of the robot was measured 
by running its actuators in different directions to the end of the moving range, 
and recording the end-effector position by the optical tracker. Trajectory track¬ 
ing experiments were performed to verify the robot’s kinematical model and to 
assess the effects of the friction and backlash. In each test, a desired trajec¬ 
tory, e.g., an offset circle, was defined for the end-effector to be followed and 
the corresponding joint trajectory for each actuator was computed, using the in¬ 
verse kinematic equations, to generate the position data of the actuators. The 
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Figure 3. Top view of the fabricated Wide-Open robot, Figure 2. Since the 
legs are positioned in one half plane, the other half plane remains open. This 
non-symmetric placement of the legs, increases the workspace and gives a wide 
usable space between the two plates. 


trajectory tracking experiments of the robot revealed reasonably acceptable re¬ 
sults. The robot was capable of moving the end-effector on a 40 (mm) radius 
circle with a maximum deviation from the reference trajectory of about 8%. 


3. Kinematic Analysis 

One of the most important issues in the study of parallel manipulators is the 
kinematic analysis, where the generated results determine the applicability of 
the designed mechanism. In what follows, the inverse kinematic analysis of the 
parallel manipulator is formulated. It is to be noted that, the forward kinematic 
problem of this robot has 16 solutions at most, and its complete analysis is out 
of scope of this chapter. 

Referring to Figure 1, a t which represents OA t can be written as 


(ti = g[ cosy,- sinji 0 } T , 
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where g and h are the radius of the fixed and moving platforms, respectively. 
B bi represents the position of the i-th joint on the platform in the moving frame 
{B}, B bi = PBi) B . B bi is constant and is equal to B bi = h[ cosy/ sinji 0 ] T . 

We can represent B R = [r/y], the rotation matrix from A to B , using Euler angles 
as 

CCC2CCC3 —ca2sa3 sa2 

bR= ca3sa2sai+sa3cai -sa3sa2sai + CCC3CCC1 -ca2sai , (1) 

—CCC3SCC2CCC1 + sa3sai sa3sa2cai+ca3sai ca2cai 

where sai = sinai and cai = cosai, and so on. ai, a 2 , and a 3 are three Euler 
angles defined according to the x — y — z convention. Thus, the vector B bi would 
be expressed in the fixed frame {A} as 

bi= A B RPBi) B . (2) 

Let p and r t denote the position vectors for P and Bi in the reference frame 
{A}, respectively. From the geometry, it is obvious that 

n=p + bi. (3) 

Subtracting vector a t from both sides of (3) one obtains 

ri-ai=p+bi-ai. (4) 

Left hand side of (4) is the definition of di, therefore 

df = (p+bj — ai) ■ (p +bi — ai). (5) 

Using Euclidean norm d\ can be expressed as 

di = ^(x-x;) 2 + (y-y;) 2 + (z-Zi) 2 ^), (6) 

in which 

{ Xi = -/z(cosy/rn +siny/r 2 i) +gcosy/ 

yi = ~h (cosy/ r i2 + sin 7/ r 22 ) + g sin y/ . (7) 

Zi = ~h (cosy/ ri 3 + siny/ r 23 ) 

Coordinates C/(A/,x/,y/,z/) are connected to the base platform with their x/ 
axes aligned with the rotary actuators in the 5/ directions, with their z/ axes 
perpendicular to the fixed platform. Thus, one can express vector di in {C/} as 

sin\|// 

Ci di = di — sin 0/ cos \|// , 

COS0/COS\|// 


( 8 ) 
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and from the geometry is clear that 


r i =a i + c i R Ci di, 

where £R is the rotation matrix from {Q} to {A}, 


A 

Q 


R = 


cosy i —sin 7 / 0 
siny* cosy/ 0 

0 0 1 


(9) 


( 10 ) 


By equating the right sides of (3) and (4)), and solving the resultant equa¬ 
tion, \|/; and 0/ can be calculated as follows: 


\|/; sin 


l cos Y/ (x — x/) + sin y,- (y — y,-) 

V dt 


and 


0/ sin 


-l 


sin Y; (x— Xj ) — cos y,- (y — y ; -) 

<7, COS \|/ ( 


( 11 ) 


( 12 ) 


4. Workspace Analysis 

Consider the Wide-Open mechanism with g = 1 (m) and h = 0.5 (m), where g 
and h are the radii of the fixed and moving platforms, respectively. By assum¬ 
ing a cubic with 1 (m) length, 1 (m) width and 1 (m) height located 0.25 (m) 
above the base platform, we are interested in determining the volume percentage 
in which the mechanism can successfully reach the locations within this cubic 
space. 

The experimental workspace of the Wide-Open robot is illustrated in Figure 
4. There were two main mechanical constraints in the fabricated prototype that 
limited its workspace. The first constraint was the length change of the linear 
actuators, d[, being between 0.22 (m) to 0.40 (m). The other restriction was 
imposed by the spherical joints, Of 7 . The spherical joints, used in our prototype, 
could rotate only up to ±25 (deg). The workspace of the mechanism can be 
enlarged to the theoretical one if these constrains are removed. Figure 4 also 
illustrates the two potential enlarged workspaces of the mechanism; one with 
the increased spherical rotation limits of ±50 (deg), and the other with an ideal 
spherical joint without a rotational constraint. 
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No 


Figure 4. Workspaces of the Wide-Open parallel mechanism with different con¬ 
straints on the spherical joint angles. Spherical joints are considered to have no 
limit, restricted to rotate up to ±50 (deg), and to ±25 (deg); respectively. 

5. Dynamic Analysis 

5.1. Inverse Dynamics 

Due to the numerous constraints imposed by closed loops of a parallel manip¬ 
ulator, deriving explicit equations of motion in terms of a set of independent 
generalized coordinates become a prohibitive task. In this regard, the principle 
of virtual work appears to be the most efficient method of analysis. In this sec¬ 
tion we apply the principle of virtual work to derive a transformation between 
joint torques/forces and end-effecter forces/moments. 

For convenience, we introduce a six-dimensional wrench F* as the sum of 
applied and inertia wrenches about the center of mass of link i. Similarly, we 
assume F p to denote the sum of applied and inertia wrenches about the center of 
mass of the moving platform. Then the principle of virtual work for a parallel 
manipulator can be stated as 

5q 7 ’r + §x T Fp + £8xfFj = 0, (13) 

i 

where, r is the wrench applied to the actuators. Sx is the virtual displacement 
and rotation of the center of the moving platform. 8x/ is the virtual displace¬ 
ment and rotation of the center of link i, and Sq is the virtual displacement and 
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rotation of q. One can relate 8q and 8x as follows 

8q = / p 8x, J p =J~ l J x . (14) 

By introducingas link’s jacobian matrix, we have 

8x, = 7,8x. (15) 

Substituting (14) and (15) into (13), results in 

yJr + Fp + ^yfF^O. (16) 

i 

If J p is a square matrix, solving for r in (16) is straight forward, which 
results in 

T = -7/^ + £yfF^. (17) 

It is to be noted that, errors in the system parameters may result in deviation 
of the platform position and orientation from those desired. Therefore, in Sec¬ 
tion 6, a robust sliding-mode controller is designed to cancel out the effects of 
parameters uncertainties and external load disturbances. 

5.2. Forward Dynamics 

In this section, the forward dynamic analysis of the Wide-Open parallel robot is 
summarized. The robot is a 6-DOF closed kinematic chain mechanism consist¬ 
ing of a fixed base, a moving platform, and 3 legs connecting the two platforms. 
The basic procedure in deriving the forward dynamic model is using Newton- 
Euler method, which incorporates the constraint forces in a compact form. The 
general equations of motion for the mechanism, in the workspace coordinates, 
could be written as [2] 


M(x)x + //(x,x) = /Jr, (18) 

where M(x) is the 6x6 mass matrix and //(x,x) is a 6 x 1 nonlinear vector 
icluding coriolis, centrifugal and gravitational effects. Forward dynamic prob¬ 
lem would be to solve (18) to obtain x as 

X = —M(x)~ l H(x,x) +M(x)~ l JpT. 


(19) 




154 M. H. Abedinnasab, J. Gallardo-Alvarado, B. Tarvirdizadeh et al. 



Figure 5. Reference trajectory of the center of the moving platform. Frequency 
of the sinusoidal movements is 27t/10. x, y, and z are translational motions and 
a, (3, and y are the roll, pitch, and yaw angles; respectively. 







Figure 6. Time history of the angular rotations, 0/, and angular velocities, 0/, of 
the rotary actuators, based on the reference trajectory in Figure 5. 

5.3. Dynamic Simulations 

In this section, we numerically investigate the inverse dynamic solution of the 
Wide-Open mechanism. The mass of the moving platform is 0.3 (kg). The 
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Figure 7. Time history of the linear displacements, du and linear velocities, du 
of the linear actuators, based on the reference trajectory in Figure 5. 








Figure 8. Inverse dynamic solution, i.e., actuators’ torques and forces, based on 
the reference trajectory in Figure 5. 


masses of the lower part and upper part of each leg are 0.9 (kg) and 0.4 (kg); 
respectively, radii of the moving platform and the fixed platform are 0.14 (m) 
and 0.18 (m); respectively. The input reference trajectory is shown in Figure 
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5. As shown in the figure, the oscillations have the same frequency of 27t/10, 
in all translational and rotational degrees of freedom. All three translational 
movements have the same amplitudes of 0.1 (m), while their initial conditions 
are different. Similarly, the rotational movements have the same amplitudes of 
0.1 (rad) or 5.73 (deg), with different initial conditions. 

Based on the same reference trajectory, time history of the rotations of the 
three active rotary actuators are shown in Figure 6 . Both angular rotations, 0/, 
and angular velocities, 0/, are shown in the figure. Time history of the displace¬ 
ments of the three linear actuators are shown in Figure 7. Linear displacements, 
di , and linear velocities, du are shown in the figure. 

Inverse dynamic solution of the reference trajectory of Figure 5, is shown in 
Figure 8 . The actuators’ torques and forces, r, are calculated from Eq. (17). It 
is to be noted that, the results for the two time periods of 10 (s) are identical. 

6. Position Control Analysis 

6.1. Sliding-Mode Control Design 

In this section, the sliding-mode control technique, which is an effective way 
for controlling nonlinear systems with un-modeled uncertainties [4], is used to 
develop a controller allowing tracking of the reference inputs for the 6 -DOF 
Wide-Open mechanism. Desired Cartesian trajectories are used as input com¬ 
mands to the controller. The controller then sets the actuators torques and forces 
in the real-time. 

In absence of disturbances and uncertain terms, the control problem would 
be easily accomplished by replacing r from inverse dynamic solution, (17), into 
(19). However, in real situations, one should consider the effects of disturbances 
and uncertainties by introducing the 6 x 1 vector A into (19) as 

X = -M(x) - 1 //(x,x) +M(x)~ l JpT + A, (20) 

in which A = [Ai, A 2 , A 3 , A 4 , A 5 , A^] T , with the following boundaries, 

I A, | < Si, (21) 

for i = 1 to 6 . It is to be noted that, it would be difficult to simultaneously 
guarantee the accuracy and robustness of a controller, when the system load is 
uncertain and varying. A lot of research studies design robust controllers to deal 
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with the external disturbances. However, it depends on the assumptions that the 
external disturbances are bounded [4]. 

To derive input actuators forces and torques, r, for the general system (20), 
one can use the following definition, 

r = T mv — r A , (22) 


where r inv stands for the input forces and torques required for the nominal sys¬ 
tem, (19), and r A is present to cancel the effects of the disturbances and uncer¬ 
tainties, A. Replacing (22) into (20), one obtains 

x = x des + A-M(x)- 1 J*T A , (23) 

in which, x des is the desired 6x1 vector of position and orientation of the center 
of the moving platform. By defining W as 


W =M(x)~ 1 JpT A , (24) 

r A will be obtained as 

t a = J~ t M{x) W. (25) 

Replacing (24) into (23) yields to 

x = x des + A —W. (26) 


The displacement error variable z,-, and its derivative z d , are respectively 
defined as, 

(27) 


„des 


and 


r,d ■des 

— A z A / * 


(28) 


Using Eqs. (26), (27), and (28), we can reach to the following second-order 
state-space system, 

7 . - 

a 1 ’ (29) 

zf = 4 i-Wi. K ’ 


One can define the sliding surface 5; as follows, 

Si = (dj dt + XijZi = zf + XiZi, 


(30) 
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where the A; parameter is chosen based on the desired convergence speed of the 
controller. The derivative of the sliding surface is obtained as, 

S i = A i -W i + X i zf. (31) 

In what follows, we use saturation function, sat(.), for omitting the noises 
generated from the sign(.) function, 

Wi = W- q + (3,-sat(5,-/<!>,•), (32) 

in which, smaller values for (|)/ result in lower errors by increasing the oscilla¬ 
tions, while larger values for <|)/ increase the error and decrease the oscillations. 
One may use the following formulation for ([)/ selection based on the maximum 
resultant error of displacement, z™ ax , 

(33) 

According to the definition, W- q is calculated from (31) by setting 5/ and A; 
to zero, 

W- q = hz d i. (34) 

We define the Lyapunov function as, 

c2 

Vi=f, (35) 

where its derivative is bounded by 

Vi = SiSi<-r\i\Si\. (36) 

By replacing Eqs. (30) and (31) into (36), and after simplifications, we reach 
to the following condition for (3/, 

§/+%< P/. (37) 

As a result, all the design parameters have defined boundaries. Finally, by 
replacing (32) into (25), the vector of input forces and torques due to existence 
of disturbances and uncertainties is determined. The general algorithm of the 
proposed closed-loop sliding-mode controller is illustrated in Figure 9. 
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Figure 9. Proposed closed-loop tracking control schematics. The sliding-mode 
controller generates the required forces and torques to cancel out the negative 
effects of the disturbances and uncertainities on the system. 

6.2. Position Control Simulations 

To verify the effectiveness and robustness of the proposed control algorithm, 
the tracking performance of the controller is evaluated in this section. The pro¬ 
posed control method is numerically evaluated in three case studies. The control 
parameters A;, (|);, and (3/ are respectively set to 5, 2, and 50 through all the nu¬ 
merical simulations. 

6.2.1. Initial Condition Alteration 

Initial condition alteration, is a classic way of analyzing the robustness and per¬ 
formance of a controller. In this section, we have altered the initial position 
of each of x, y, and z translational degrees of freedom by 0.2 (m) from that of 
the reference trajectory in Figure 5. As seen from the Figure 10, the controller 
is well capable of following the reference trajectory with zero error, after the 
first few seconds. The corresponding actuators’ forces and torques are shown 
and compared to those of the reference trajectory in Figure 11. As expected, an 
overshoot is seen right after the start point, then the forces and torques rapidly 
converge to those of the reference trajectory. 

6.2.2. Parameters Uncertainties 

As another simulation, the robustness of the controller can be demonstrated by 
applying the controller to the system with different parameter values. Parame¬ 
ters uncertainties could be well modeled using this approach. To this end, every 
component’s mass in the system is considered to be 20% larger than that re¬ 
ported and initiated in the controller. This way, the controller will be faced to 
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the presence of a relatively large parametric uncertainty. The trajectory track¬ 
ing results are shown in Figure 12. As seen in the figure, even though there 
is a strong parametric uncertainty in the system, the controller has successfully 
tracked the reference trajectory in a satisfactory fashion. It is to be noted that, 
unlike the initial condition alteration, the parametric difference of 20% is always 
present in the controller, and therefore the output trajectory can not converge to 
the reference trajectory after awhile. The corresponding actuators’ forces and 
torques are shown and compared to those of the reference trajectory in Figure 
13. As seen in the figure, an offset is seen between most pairs of the gray and 
black lines. This simulation, illustrates the robustness of the proposed sliding¬ 
mode controller in the existence of parameters uncertainties. 


30 

_ 20 
E 

* 10 


0 

0 








Figure 10. Initial condition of the system is altered with that of the reference 
trajectory. The initial position of each of x, y, and z differs 0.2 (m) with that 
of the reference trajectory. The initial orientation of each of a, (3, and y differs 
0.2 (rad) or 11.46 (deg), with that of the reference trajectory. Black line: output 
trajectory of the system. Gray line: reference trajectory, i.e., Figure 5. 


6.2.3. External Disturbances 

Load disturbances are the main external disturbances of the parallel manipula¬ 
tors, and greatly impact the system performance [4]. To study the robustness of 
the proposed controller when an external disturbance occurs, the moving plat- 
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Figure 11. Black line: actuators’ forces and torques corresponding to the ini¬ 
tial condition change, i.e., Figure 10. Gray line: actuators’ forces and torques 
corresponding to the reference trajectory, i.e., Figure 8. 



Figure 12. Mass of the components of the system is increased by 20% compared 
to the data initiated in the controller model. Black line: output trajectory of the 
system. Gray line: reference trajectory, i.e., Figure 5. 


form is hit with an external load from three directions of x, y, and z. The load 
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Figure 13. Black line: actuators’ forces and torques corresponding to the mass 
change simulation, i.e., Figure 12. Gray line: actuators’ forces and torques 
corresponding to the reference trajectory, i.e., Figure 8. 


hits the platform at t = 5 (s) and is detached after 0.2 (s). The magnitude of 
the load is 9.81 (N), in each direction. The results of the simulation is shown 
in Figure 14. The corresponding actuators’ forces and torques are shown and 
compared to those of the reference trajectory in Figure 15. It is obvious from 
the figures that the controller is able to cancel out the sudden impact of the ex¬ 
ternal disturbance by properly overshooting the actuators’ forces and torques, 
right after the incident. Shortly after, the output trajectory is identical with the 
reference trajectory. 

Conclusion 

The 6-DOF 3-legged Wide-Open parallel mechanism was analyzed. In compar¬ 
ison with the well-known Gough-Stewart platform, the passive universal joints 
are replaced with active joints, reducing the number of legs from 6 to 3. Since 
the active rotary actuators are resting on the fixed plate, the moving platform of 
the robot can achieve higher accelerations, due to the smaller inertial effects. 

The development of a sliding-mode tracking controller for the 6-DOF Wide- 
Open mechanism was investigated, using the dynamic model of the parallel 
robot. Lyapunov analysis approach was used in designing the sliding-mode 
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Figure 14. An external load hits the moving platform in all three x, y, and z 
directions. The load hits the platform at t = 5 (s) and is detached after 0.2 (s). 
The magnitude of the load is 9.81 (N), in each direction. Black line: output 
trajectory of the system. Gray line: reference trajectory, i.e., Figure 5. 
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Figure 15. Black line: actuators’ forces and torques corresponding to the ex¬ 
ternal load impact, i.e., Figure 14. Gray line: actuators’ forces and torques 
corresponding to the reference trajectory, i.e., Figure 8. 
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controller. The trajectory tracking control of the 6-DOF parallel robot with un¬ 
certain load disturbances and parameter uncertainties was demonstrated through 
three numerical simulations. The simulation results show that the proposed non¬ 
linear control strategy is robust in presence of disturbances and uncertainties. 
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